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机 械 工 业 出 版 社 


由 施 普 林 格 出 版 社 出 版 的 《机 器 人 手册 》 主要 介绍 了 20 世纪 80 年 代 
以 来 人 们 在 机 化 人 技术 方面 的 努力 成 果 ， 是 100 多 位 来 目 不 同 国家 的 科学 
家 几 十 年 努力 研究 的 成 果 。 本 手册 从 学 科 基 础 入 手 ,， 介绍 了 机 峰 人 各 个 日 
有 成 效 的 研究 领域 ， 包 括 最 新 出 现 的 机 器 人 各 种 应 用 ， 展 现 了 机 器 人 学 领 
域 的 一 幅 全 面 图 景 。 本 书 共 分 7 篇 ， 其 中 各 章 均 运用 经 典 的 方法 引导 出 将 
阐述 的 内 容 ， 避 人 免 了 正在 接受 验证 和 尚未 完全 成 熟 的 方法 。 本 书 内 容 先 进 ， 
实用 性 强 ， 是 机 械 、 控 制 、 传 感 器 技术 、 信 息 信 和 号 处 理 、 模 式 识别 、 人 工 
智能 和 计算 机 技术 交叉 领域 内 具有 前 沿 性 、 综 合 性 及 权威 性 的 著作 ， 为 推 
动机 器 人 领域 研究 的 快速 发 展 将 起 到 极其 重要 的 作用 。 

本 手册 内 容 深 入 浅 出 ,并 附 有 大 量 的 科研 实例 ， 便 于 自学 和 应 用 ， 可 
作为 机 器 人 、 人 工 智 能 、 自 动 化 、 控 制 以 及 计算 机 应 用 等 专业 科研 人 员 、 
高 校 教 师 的 参考 用 书 ， 也 可 作为 相关 专业 本 科 生 或 研究 生 的 参考 教材 ， 还 
可 供 机 器 人 业余 爱好 者 们 参考 。 
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译 从 F 


一 、 机 械 工 程 高 速 发 展 

机 械 工程 是 以 自然 科学 和 技术 科学 为 理论 基础 ， 结 合 在 生产 实践 中 积累 的 技术 经 验 ， 研 究 和 解决 机 械 产品 
开发 、 设 计 、 制 造 、 安 装 、 运 用 、 修 理 及 再 制造 等 方面 的 全 部 理论 和 实际 应 用 的 学 科 。 机 械 工程 的 学 科 内 容 包 
括 ， 机 械 工程 基础 理论 研究 ， 机 械 产品 开发 、 设 计 ， 机 械 产品 的 制造 、 装 备 、 检 验 ， 机 械 产 品 的 应 用 与 维护 ， 
机 机 制造 企业 的 经 营 和 管理 ， 机 械 产 品 的 绿色 生命 周期 等 问题 及 技术 措施 。 机 械 工 程 先 进 技术 涉及 设计 、 制 
ORR. PSK ER, RS. BRL MA, RAS STRAW AER. 

20 世纪 后 期 ， 特 别 是 进入 21 世纪 ， 计 算 机 、 信 息 技 术 在 机 械 工 程 领域 的 广泛 、 深 入 应 用 ， 使 机 械 工程 技 
坟 高 速 发 展 。 机 械 工程 技术 由 线性 到 非 线性 、 由 静态 到 动态 、 由 二 维 到 三 维 的 研究 发 展 ， 为 现代 机 械 设计 方法 
的 研究 、 应 用 奠定 了 工程 理论 基础 虚拟 技术 、 创 新 设计 、 绿 色 设计 、 并 行 工程 等 ， 为 现代 机 械 设计 提供 了 技 
术 基础 ， 机 床 数控 技术 、 工 业 机 器 人 、 和 柔性 制造 技术 、 传 感 技术 、 集 成 制造 技术 、 自 动 检测 及 信号 识别 技术 
等 ， 为 机 械 制造 工艺 自动 化 提供 了 支撑 技术 ; ERP (企业 资源 计划 )、MES (制造 管理 信息 系统 ) CMS (it 
算 机 集成 制造 系统 ) 等 ， 为 机 械 制 造 企 业 的 经 营 和 管理 提供 了 现代 化 的 支撑 平台 ; PLM (产品 全 生命 周期 管 
理 )、IWM (文物 管理 一 体 化 ) EMS (环境 管理 体系 ) 等 理念 、 技 术 的 发 展 ， 已 成 为 机 械 工程 先进 技术 的 重 
要 组 成 部 分 。 

机 被 工程 先进 技术 是 实现 工业 技术 现代 化 重要 的 技术 支撑 之 一 。 但 是 ， 机 械 工程 先进 技术 的 发 展 要 受到 自 
然 条 件 、 经 济 条 件 、 社 会 条 件 、 技 术 基础 等 的 限制 ， 我 国 作为 发 展 中 国家 ， 在 机 械 工程 先进 技术 方面 同 工 业 发 
大 国家 还 有 很 大 差距 。 为 了 加 快 我 国 机 械 工程 先进 技术 的 发 展 进程 ， 通 过 各 种 方式 引进 外 国 机 械 工程 先进 技 
术 ， 是 一 条 切实 可 行 的 发 展 之 路 。 


二 、 图 书 交 流传 播 知识 


图 书 资料 是 一 种 传统 、 永 恒 、 有 效 的 学 术 、 技 术 交 流 方式 。 早 在 20 世纪 初期 ， 我 国清 代 学 者 严复 就 翻译 
了 英国 学 者 赫 硝 歼 所 著 的 《天 演 论 》， 其 后 学 者 周 建 人 翻译 了 英国 学 者 达尔 文 所 著 的 《物种 起 源 》， 对 我 国 日 
然 科 学 的 发 展 起 到 了 很 大 的 推动 作用 。 

图 书 是 一 种 信息 载体 ， 图 书 是 一 个 海洋 ， 虽 然 现在 已 有 网 络 通信 、 计 算 机 等 信息 传输 和 储存 手段 ， 但 图 书 
仍 将 以 严谨 性 、 系 统 性 、 广 泛 性 、 适 应 性 、 持 久 性 和 和 经济 性 而 长 期 存在 。 纸 质 图 蔬 有 更 好 的 阅读 优势 ， 司 满足 
不 同 层次 读者 的 阅读 习惯 ,同时 它 具 有 长 期 的 参考 价值 和 收藏 价值 。 

诉 年 来 ， 国 际 间 的 交流 与 合作 对 机 械 工 程 技术 领域 的 发 展 、 技 术 进 步 及 重大 关键 技术 的 突破 起 到 了 积极 的 
促进 作用 ， 对 机 械 工 程 技 术 领 域 科技 人 员 及 时 了 解 国外 相关 技术 领域 的 最 新 发 展 状况 、 取 得 的 最 新 成 果 及 应 用 
情况 等 ， 发 挥 了 积极 作用 。 

机械 工业 出 版 社 希 望 通过 引进 、 翻 译 国外 机 械 工程 技术 领域 的 先进 技术 图 蔬 ， 传 播 国 外 机 械 工程 领域 的 先 
洲 技 术 ， 推 动 国内 学 者 和 技术 人 员 对 国外 机 械 工程 先进 技术 的 引进 、 消 化 、 吸 收 和 创新 发 展 。 从 而 提升 我 国 机 
被 工程 技术 的 自主 创新 能 力 ， 提 高 我 国 装备 制造 业 的 技术 水 平 ， 加 速 实现 我 国 工业 的 现代 化 。 


三 、 精 挑 细 选 精 雕 细 刻 


为 真正 实现 翻译 国外 机 械 工程 技术 领域 先进 技术 图 书 、 推 动 我 国 机 械 工程 技术 发 展 的 战略 目标 ， 栅 械 工业 
出 版 社 将 认真 执行 : 

(1) 精 挑 细 选 坚持 从 机 械 工程 技术 比较 发 达 的 国家 、 国 外 优秀 出 版 社 引进 优秀 技术 图 书 ， 组 成 一 套 
《国际 机 械 工程 先进 技术 译 从 》。 本 套 译 从 将 涵盖 机 械 工程 的 基础 理论 研究 ， 产 品 开发 、 设 计 、 制 造 、 运 必 、 
维修 、 再 制造 和 资源 、 环 保 、 信 息 、 管 理 等 相关 学 科 。 


IV 译 A È 





(2) 精 雕 细 刻 ”本 套 从 书 的 选 书 、 翻 译 工作 均 由 国内 相关 专业 的 专家 、 教 授 、 工 程 技术 人 员 把 关 ， 以 充 
ORLA BAAN THE. ERR RE. ARMED SAN. KL BH, 真正 实现 传播 国际 机 械 工 程 先 
进 技术 ， 服 务 于 国内 机 械 工程 技术 的 发 展 。 

(3) HARR 本 套 从 书 作 为 我 社 的 精品 重点 书 ， 将 统一 封面 装帧 设计 ， 在 版 式 编排 、 内 容 编校 、 图 书 
印 制 等 方面 追求 高 质量 ， 把 “精品 ”体现 到 书 的 整体 中 去 ,力求 为 读者 奉献 一 套 高 品质 的 《国际 机 械 工程 先 
HRA A) o 

RRA Hae 


首先 要 感谢 广大 积极 热心 支持 出 版 《国际 机 械 工程 先进 技术 译 丛 》 的 专家 学 者 ， 积 极 推荐 国外 相关 优秀 
图 书 ， 仔 细 评 审 外 文 原版 书 ， 推 荐 翻译 的 知名 专家 ; 特别 要 感谢 承担 翻译 工作 的 译 者 所 付出 的 辛勤 劳动 ; 同时 
要 感谢 从 事 图 书 版 权 贸 易 的 工作 人 员 的 辛勤 工作 。 


本 套 从 书 希望 能 对 广大 读者 的 工作 提供 切实 的 帮助 ， 欢 迎 广 大 读者 不 癌 指 教 ， 提 出 宝贵 意见 和 建议 。 


机 械 工 业 出 版 社 《 国 际 机 械 工 程 先进 技术 译 从 》 编 委 会 


作者 太一 


我 对 机 器 人 学 的 首次 了 解 是 源 自 1964 年 的 一 个 电话 。 打 电话 的 人 是 
Fred Terman， 世 界 著名 的 《无 线 电 工程 师 手 和 册 》 的 作者 ， 当 时 任 斯 坦 福 
大 学 教务 长 。Terman 博士 告诉 我 计算 机 科学 教授 John McCarthy 刚 获得 一 
大 笔 研 究 经 费 ， 其 中 的 一 部 分 将 用 于 开发 计算 机 控制 的 机 械 辟 。 有 人 向 
Terman 建议 ,如果 以 数学 为 方向 的 McCarthy 教授 和 机 械 设计 师 联 手 ， 这 
将 会 是 很 聪明 的 做 法 。 由 于 我 是 斯 坦 福 教员 中 唯一 有 机 械 设计 专长 的 人 ， 
Terman 打算 给 我 打 个 电话 ， 尽 管 我 们 从 未 谋面 ， 而且 我 还 是 个 刚刚 研究 
生 毕 业 、 在 斯 坦 福 只 工作 了 两 年 的 年 轻 助理 教授 。 

Terman 博士 的 电话 使 我 与 John McCarthy 和 他 创建 的 斯 坦 福 人 工 智能 
实验 室 (SAIL) 有 了 紧密 的 联系 。 机 器 人 成 了 我 整个 学 术 生 涯 的 支柱 ， Bernard Roth 
直到 今天 ， 我 一 直 保 持 着 对 这 一 主题 的 教学 与 研究 兴趣 。 美国 斯 坦 福 大 学 机 械 工程 教授 

ALE AH AUR BRE 20 世纪 40 年 代 后 期 ， 当 时 伺服 控 
制 的 机 械 辟 被 开发 出 来 ， 它 与 主 从 方式 的 机 械 辟 连接 起 来 被 用 于 处 理 核 物质 ， 从 而 保护 相关 人 员 。 这 一 领域 的 
发 展 一 直 延 续 到 现在 。 然 而 在 20 世纪 60 年 代 初 期 ， 还 很 少 有 关于 机 器 人 学 的 学 术 活 动 和 商业 活动 。 首 个 学 术 
活动 是 1961 年 麻 省 理工 学 院 H. A. Emst 的 论文 。 他 用 装 有 触觉 传感器 的 从 动机 械 臂 在 计算 机 控制 下 工作 。 他 
的 研究 思想 就 是 利用 触觉 传感器 中 的 信息 来 引导 机 械 导 运动 。 

之 后 斯 坦 福 人 工 智 能 实验 室 随 之 开展 了 相关 项 目 ， 麻 省 理工 学 院 Marvin Minsky 教授 也 启动 了 类 似 的 项 目 ， 
这 些 研究 在 当时 是 在 机 器 人 学 领域 为 数 不 多 的 学 术 冒 险 。 这 些 尝试 中 的 少数 是 在 商业 机 械 展 方面， 大 部 分 与 汽 
车 工业 生产 相 联 系 。 在 美国 ， 在 汽车 工业 中 对 两 种 不 同 的 机 械 辟 设计 进行 了 实验 : 其 中 一 种 来 自 AMF 公司 ， 
另 一 种 来 自 Unimation 公司 。 

另外 还 有 一 些 制 造成 手 、 腿 和 和 怖 部 假肢 的 机 械 装置 ,不 久之 后 ,为 了 提高 人 的 能 力 还 出 现 了 外 骨骼 装置 。 
那 时 还 没有 微 处 理 器 ， 所 以 这 些 装 置 既 不 受 计算 机 控制 ， 也 不 受 远 程 的 所 谓 微机 所 还 控 ， 更 不 用 说 大 型 计算 机 
控制 了 。 

最 初 ， 计 算 机 科学 领域 中 的 一 些 人 认为 计算 机 已 足够 强大 ， 可 以 控制 任何 机 械 设 备 ， 并 使 其 完美 执行 。 但 
我 们 很 快 发现 并 非 如 此 。 我 们 分 两 条 路 线 进 行 。 其 一 是 为 斯 坦 福 人 工 智能 实验 室 (SAL) 开发 特殊 设备 装置 ， 
以 保证 刚刚 起 步 的 机 器 人 团队 开展 实验 达到 硬件 证 明 与 概念 验证 系统 。 另 一 条 路 线 或 多 或 少 与 斯 坦 福 人 工 智能 
实验 室 的 工作 相关 ， 是 发 展 机 器 人 的 基础 机 械 科学 。 我 有 一 种 强烈 的 感觉 ， 可 能 会 发 展 出 一 项 有 意义 的 科学 。 
我 们 最 好 从 基本 概念 的 方面 思考 ， 而 不 是 专门 集中 在 特定 的 设备 上 面 。 

幸运 的 是 ， 两 种 路 线 竟 然 相 互 冰 非常 和 谐 融 洽 。 更 重要 的 是 ， 研 究 者 们 对 这 一 领域 的 研究 很 感 兴趣 。 硬 件 
开发 为 更 多 的 基本 概念 提供 了 具体 的 例证 ， 研 究 者 们 能 够 同时 开发 硬件 和 理论 。 

起 初 ， 为 了 尽快 开始 研究 ， 我 们 购买 了 一 只 机 械 辟 。 在 洛杉矶 的 Rancho Los Amigos 医院 有 人 在 销售 一 种 
开关 控制 型 电动 机 了 驱动 的 外 上 骨骼 机 械 辟 ， 用 来 帮助 那些 辟 部 失去 肌肉 的 患者 。 我 们 购买 了 一 人 台 ， 把 它 连接 在 
PDP-6 型 分 时 计算 机 上 。 这 大 ,设备 被 命名 为 “奶油 手指 ”， 它 是 我 们 的 第 一 个 实验 机 带 人 。 一 些 电 影展 示 的 视 
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第 一 个 由 我 们 自主 设计 的 操纵 器 被 简单 认为 是 “水 压 辟 ”。 正 如 它 的 名 字 所 指 ， 它 是 由 水 力 驱 动 的 。 要 建 
立 一 个 非常 快 的 手 怖 ， 我们 设计 了 特殊 的 旋转 驱动 器 ， 这 个 手臂 工作 得 非常 好 。 它 成 为 了 最 早 测试 机 器 人 手 剧 
的 动态 分 析 和 时 间 最 优化 控制 的 实验 平台 。 然 而 ， 当 时 普遍 来 说 ， 计算、 规划 和 传 感 性 能 都 很 有 限 ， 由 于 设计 
速度 比 要 求 速 度 快 得 非常 多 ,使 得 这 项 技术 的 应 用 很 受 限制 。 

我 们 尝试 去 开发 一 个 真正 的 数字 化 手臂 。 从 而 产生 了 一 个 蛇 形 结构 ， 取 名 为 Om (MRE PH), Orm 
有 若干 节 ， 每 节 有 膨胀 的 气动 驱动 器 阵列 ， 它 们 要 么 完全 伸展 ， 要 么 完全 收缩 。 基 本 思想 是 : 虽然 在 工作 空间 
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中 Orm 仅 可 达到 有 限 数 量 的 位 置 ， 但 是 如 果 达 到 的 位 置 有 很 多 ， 那么 这 也 是 足够 的 。 一 个 经 过 概念 验证 的 小 
型 原型 Orm 被 开发 出 来 ， 然 而 我 们 发 现 这 种 类 型 的 手臂 不 能 用 于 斯 坦 福 人 工 智能 实验 室 团队 。 

我 们 实验 室 第 一 个 真正 具有 功能 的 手臂 是 由 当时 的 研究 生 Victor Scheinman 设计 的 ， 它 就 是 非常 成 功 的 
“斯 坦 福 手 异 ”。 有 十 几 个 这 种 手臂 作为 研究 工具 用 于 不 同 的 大 学 、 政 府 和 工业 实验 室 。 它 有 六 个 独立 驱动 关 
节 ， 均 由 计算 机 控制 的 直流 伺服 电动 机 驱动 。 其 中 一 个 关节 是 棱柱 的 ， 另 外 五 个 是 旋转 的 。 

鉴于 “奶油 手指 ”的 几何 学 需要 逆 运 动 学 的 迭代 解 ， 因 此 选择 “斯 坦 福 手 辟 ”的 儿 何 构 型 ， 即 可 以 通过 
编程 获得 其 递 运动 学 的 迭代 解 ， 应 用 起 来 简单 而 高 效 。 而 且 ， 这 个 机 械 设 计 是 特别 制作 的 ， 以 兼容 分 时 计算 机 
控制 固有 的 局 限 性 。 不 同 的 末端 执行 器 被 连接 到 机 械 避 末端 作为 手 。 在 我 们 的 版 本 中 ， 手 被 做 成 错 夹 的 形式 ， 
还 有 两 只 清 动 手指 ， 两 只 手指 由 一 台 人 饲 服 驱动 器 了 驱动， 因此， 手臂 的 实际 自由 度数 目 有 7 个 。 它 也 有 一 个 特别 
设计 的 六 轴 腕 部 力 传 感 紫 。Victor Scheinman 继续 开发 了 其 他 重要 的 机 器 人 : 首先 是 一 个 有 六 个 旋转 关节 的 小 
型 仿 人 手臂 。 最 初 设计 是 由 麻 省 理工 学 院 人 工 智能 实验 室 Marin Minsky 资助 的 。Victor Scheinman 建立 了 
Vicarm 公司 ,这 是 一 家 小 公司 ， 为 其 他 实验 室 制造 了 这 个 手 辟 和 “斯 坦 福 手 怖 ”。Vicarm 后 来 成 为 了 Unimation 
公司 的 西海 岸 分 部 ， 在 那里 ， 通 过 Unimation 公司 在 通用 电机 公司 资助 下 他 设计 了 PUMA FLARE, 后 来 ， 
Scheinman 为 Automatix 公司 开发 了 全 新 的 Robot World 多 机 器 人 系统 。 在 Scheinman 离开 Unimation 后 ， 他 的 司 
事 Brian Carlisle 和 Bruce Shimano 重组 了 Unimation 公司 的 西海 岸 分 部 Adept 公司 ， 该 公司 现在 是 美国 最 大 
的 装配 机 器 人 制造 商 。 

很 快 ， 精 密 机 械 和 电子 设计 、 优 化 的 软件 ， 以 及 完整 系统 集成 的 现代 化 趋势 成 为 常态 。 到 现在 ， 这 些 结合 
是 最 高 级 机 器 人 装置 的 标志 。 这 是 在 “机 械 电子 ”( 又 译 “ 机 电 一 体 化 ”或 “电子 机 械 ”，mechatronie) Y% 
的 基本 概念 。“ 机 械 电 子 ” 这 个 词 发 源 于 日 本 ， 它 代表 机 械 和 电子 两 个 词 的 串联 。 依 赖 于 计算 的 机 被 电子 ， 正 
如 我 们 今天 所 知 的 ， 是 机 器 人 固有 技术 的 实质 。 

随 着 机 器 人 技术 在 全 世界 的 发 展 ， 很 多 人 开始 在 与 机 器 人 相关 的 领域 工作 ,一 些 特有 的 附属 专业 得 到 了 发 
展 。 首 先 最 大 的 分 化 是 进行 机 械 辟 工作 的 人 和 视觉 系统 工作 的 人 。 早 期 ， 视觉 系 统 在 给 出 机 器 人 周转 环境 的 信 
息 方面 看 起 来 比 其 他 方法 更 有 前 途 。 

视觉 系统 是 通过 摄像 机 来 捕获 周围 物体 的 图 片 ， 然 后 使 用 计算 机 算法 对 图 像 进 行 分 析 ， 从 而 推断 出 物体 的 
位 置 、 方 位 和 其 他 特性 。 图 像 系统 最 初 的 成 功 在 于 解决 定位 障碍 物 问 题 、 解 决 物体 操作 问题 和 读 取 装配 工程 
图 。 人 们 感到 视觉 用 于 与 工厂 自动 化 和 太空 探索 有 关 的 机 器 人 系统 中 具有 很 大 潜力 。 这 致使 人 们 开始 研究 可 以 
通过 视觉 系统 识别 机 器 零件 〈 特 别 对 于 部 分 封闭 的 零件 ， 发 生 在 所 谓 的 “ 拾 箱 ” 问 题 中 ) 和 形状 不 规则 的 碎 
石 的 软件 。 

在 “看 ”和 移动 物体 的 能 力 被 建立 以 后 ， 下 一 个 合理 的 需要 就 是 让 机 跨 人 做 一 系列 事件 的 规划 、 去 完成 
一 项 复杂 的 任务 。 这 使 得 规划 的 发 展 成 为 机 器 人 技术 非常 重要 的 分 支 。 在 固定 的 环境 中 制定 固定 的 计划 相对 来 
说 是 很 直接 的 。 然 而 ， 在 机 器 人 技术 中 ， 面 临 的 挑战 之 一 就 是 ， 由 于 误差 或 者 未 计划 的 事件 ， 环 境 发 生 了 未 预 
料 到 的 变化 ， 此 时 ， 机 器 人 会 发 现 环 境 的 变化 并 且 修 改 自 身 的 行动 。 在 此 领域 的 一 些 里 程 碑 事 件 是 通过 使 用 一 
他 叫做 Shakey 的 车 辆 来 开展 的 ， 开 始 于 1966 年 ， 由 斯 坦 福 研究 所 (现在 称 为 SRI) 的 Charlie Rosen 小 组 开发 。 
Shakey 有 一 他 摄像 机 、 上 距离 探测 器 、 碰 撞 传 感 器 ， 通 过 无 线 电 和 视频 连接 到 DEC PDP-10 和 PDP-15 计算 机 上 。 

Shakey 是 第 一 全 可 以 思考 自己 行动 的 移动 机 器 人 。 它 利用 程序 获得 独立 感知 、 周 围 环 境 模仿 和 产生 动作 的 
能 力 。 低 级 别 的 操作 程序 负责 简单 的 移动 、 转 动 和 路 径 规 划 。 中 级 别 的 操作 程序 包含 若干 个 低级 别 程序 ,可 以 
完成 更 复杂 的 任务 。 最 高 级 的 操作 程序 能 够 制定 和 执行 计划 来 实现 用 户 提 出 的 高 级 目标 。 

视觉 系统 对 于 导航 、 物 体 定位 和 确定 它们 之 问 的 相对 位 置 与 方位 非常 有 用 。 然 而 ， 当 在 具有 环境 约束 力 的 
地 方 ， 对 于 装配 零件 或 者 与 其 他 机 器 人 一 起 工作 ， 只 有 视觉 系统 通常 是 不 够 的 。 因 而 产生 了 一 种 需求 : 对 环境 
施加 到 机 器 人 上 的 力 和 力矩 进行 测量 ， 并 利用 测量 结果 来 控制 机 器 人 的 行动 。 多 年 以 来 ， 力 控制 操作 成 为 了 斯 
坦 福 人 工 智能 实验 室 和 遍布 世界 的 其 他 儿 个 实验 室 的 主要 研究 课题 之 一 。 力 控制 在 工业 实践 中 的 使 用 始终 落后 
于 该 领域 的 研究 发 展 。 这 是 由 于 尽管 高 级 的 力 控制 系 统 对 于 通用 的 操作 问题 非常 有 效 ， 但 限制 非常 苛刻 的 工业 
环境 的 特殊 间 题 经 常 只 能 在 有 限 的 力 控 制 甚至 没有 力 控制 时 解决 

在 20 世纪 70 年 代 ， 行 走 机 器 、 机 械 手 、 自 动 汽车 、 多 传感器 信号 融合 和 恶劣 环境 设计 等 专门 领域 开始 快 
速 发 展 。 今 天 有 大 量 的 、 不 同 的 以 机 器 人 为 主题 的 专门 性 研究 ， 其 中 有 一 些 是 经 典 的 工程 学 科 领 域 ， 如 运动 
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学 、 动 力学 、 控 制 学 、 机 器 设计 、 拓 扑 学 和 轨迹 规划 。 每 一 个 学 科 在 研究 机 器 人 技术 之 前 都 已 经 走 过 了 一 段 漫 
长 的 路 程 ， 而 为 了 发 展 机 器 人 系统 和 应 用 ， 每 一 个 学 科 已 成 为 深入 研究 机 器 人 技术 的 一 个 方面 。 

在 理论 正在 发 展 的 同一 时 间 里 ， 工 业 机 器 人 ， 尽 管 稍微 有 些 分 离 ， 也 有 了 并 行 的 发 展 。 在 日 本 和 了 欧洲 ， 商 
业 开 发 强劲 ， 美 国 也 相继 发 展 。 相 关 的 工业 协会 纷纷 成 立 〔 日 本 机 器 人 协会 在 1971 年 3 月 成 立 ， 美 国 的 机 器 
人 工业 协会 (RIA) 在 1974 年 成 立 ) ， 定 期 举行 协会 展览 会 ， 并 召开 了 应 用 导向 的 技术 会 议 。 其 中 最 重要 的 有 
工业 机 器 人 国际 研讨 会 〈JISIR) 、 工 业 机 器 人 技术 会 议 〈 现 在 称 为 工业 机 器 人 技术 国际 会 议 〈ICIRT)) 以 及 国 
际 机 器 人 和 视觉 展览 与 会 议 ( 这 是 由 RIA 每 年 举办 的 贸易 展览 会 )。 

第 一 个 定期 的 系列 会 议 在 1973 年 召开 。 它 强调 机 器 人 技术 的 各 个 研究 方面 ， 而 不 仅仅 是 工业 上 的 。 它 由 
在 意大利 鸟 迪 内 的 机 械 科技 国际 中 心 (CISM) 和 机 械 与 机 器 理论 国际 联合 会 (IFToMM ) J E HEB CRG 
IFToMM 仍 在 使 用 ， 但 是 意义 已 经 变 为 机 械 与 机 器 科学 促进 国际 联合 会 ) 。 该 会 议 的 名 称 是 机 器 人 与 机 械 展 的 
理论 与 实践 大 会 (RoManSy) ， 明 显 特征 是 强调 机 械 科 学 和 来 自 东欧 、 西 欧 ， 还 有 北美 和 日 本 的 科研 人 员 们 的 
积极 交流 、 分 享 成 果 ， 会 议 现在 仍然 每 半年 举行 一 次 。 在 我 个 人 的 笔记 里 ， 就 是 在 RoManSy 会 议 中 ， 我 首次 
调 到 了 这 本 手册 的 各 位 编辑 : 1978 年 遇 到 了 Khatib +, 1984 年 遇 到 了 Siciliano 博士 。 他 们 当时 都 是 学 生 : 
Bruno Siciliano 攻读 他 的 博士 学 位 已 经 差不多 一 年 了 ，Oussama Khatib 那 时 刚刚 完成 了 他 的 博士 学 位 研究 。 两 个 
事件 ， 都 让 人 产生 一 见 钟 情 的 感觉 ! 

众多 其 他 新 的 会 议和 研讨 会 迅速 加 入 到 RoManSy 里 面 。 如 今 ， 每 年 有 大 量 机 器 人 研究 导向 的 会 议 在 许多 
国家 举行 。 当 前 ， 最 大 型 的 会 议 是 一 般 吸 引 了 超过 1000 位 参 会 者 的 IEEE 机 器 人 与 自动 化 国际 会 议 (CRA). 

在 20 世纪 80 年 代 初 期 ，Richard Paul 撰写 了 美国 第 一 本 真正 关于 机 器 人 操作 的 教材 《机 器 人 操作 一 煞 
学 、 编 程 与 控制 》 出 版 社 (Richard P. Paul, MIT, 1981), 它 把 经 典 力学 学 科 的 理论 应 用 到 机 器 人 领域 。 另 外 ， 
蔬 中 有 一 些 主题 是 从 他 在 斯 坦 福 人 工 智能 实验 室 的 论文 研究 中 直接 发 展 而 来 (在 书 里 面 ， 许多 例子 基于 
Scheinman 的 “斯 坦 福 手 辟 "。) 。Paul 的 书 是 美国 的 一 个 里 程 碑 事 件 ， 它 为 将 来 一 些 有 影响 力 的 教材 开创 了 一 
个 模式 ， 还 鼓励 众多 的 大 学 与 学 院 开设 专门 的 机 器 人 谋 程 。 

差不多 与 此 同时 ， 一 些 新 的 期 刊 创刊 ， 这 些 期 刊 主 要 发 表 机 器 人 相关 领域 的 论文 。 在 1982 年 的 春天 ， 《机 
器 人 研究 国际 期 刊 》 创 刊 ， 三 年 之 后 , 《IEEE 机 器 人 与 自动 化 期 刊 》( 现 在 的 《下 EPE 机 器 人 学 报 》) 创刊 。 

随 着 微 处 理 器 的 普及 ， 关 于 什么 是 或 什么 不 是 机 器 人 的 问题 更 加 凸显 出 来 。 在 我 的 脑海 星 ， 这 个 争论 从 来 
没有 被 很 好 地 解决 过 。 我 认为 永远 不 会 有 一 个 大 家 都 普遍 同意 的 定义 。 当 然 ， 存在 着 科幻 小 说 中 各 种 各 样 的 外 
太空 生物 和 戏院 、 文 学 以 及 电影 中 的 机 器 人 。 早 在 工业 革命 之 前 ， 就 有 过 想象 中 的 类 似 机 器 人 生物 的 例子 ,但 
实际 的 机 器 人 又 会 是 什么 样 的 呢 ? 我 认为 关于 机 器 人 的 定义 实质 上 是 一 个 随 着 科技 进步 而 不 断 改 变 其 本 体 特征 
的 移动 靶 。 例 如 当 稻 上 的 陀螺 仪 自动 罗盘 第 一 次 被 开发 出 来 时 就 被 认为 是 一 个 机 器 人 。 现在 ， 当 我 们 罗列 在 我 
们 世界 中 的 机 器 人 的 时 候 ， 总 是 无 法 完全 讲 括 所 有 的 机 器 人 。 机 器 人 的 定义 已 经 被 降级 了 ， 现在 机 器 人 被 看 做 
是 一 种 自动 控制 装置 。 

对 于 很 多 人 来 说 ， 机 器 人 包含 着 多 功能 的 概念 ， 机 器 人 即 意味 着 在 设计 和 制造 时 就 具备 了 容易 适应 或 者 可 
被 重新 编程 以 完成 不 同 任务 的 能 力 。 在 理论 上 ， 这 种 想法 应 该 可 以 实现 的 ， 但 在 实际 中 ， 却 是 大 多 数 的 机 器 人 
装 署 只 能 在 非常 有 限 的 领域 里 实现 多 功能 。 人 们 很 快 发 现 ， 在 工业 中 一 般 而 言 ， 一 人 台 具 有 专门 用 途 的 机 器 要 比 
_ 台 具有 广泛 用 途 的 机 器 表现 好 得 多 。 而 且 在 制造 加 工时 ， 当 产品 的 产量 尽 够 高 的 时 候 ， 一 他 具有 专门 用 途 的 
机 器 要 比 一 台 具 有 广泛 用 途 的 机 器 花费 少 。 因 此 ， 人 们 开发 出 专业 机 器 人 用 于 喷漆 、 锦 接 、 零 部 件 装配 、 压 力 
加 载 、 电 路 板 填 充 等 方面 。 在 一 些 情况 下 ,机 器 人 被 用 于 如 此 专 一 的 用 途 ， 以 至 于 很 难 划 清 一 他 所 谓 的 机 凡人 
与 条 可 调整 的 “固定 的 ”自动 化 流水 线 的 界限 。 人 们 理想 中 的 机 器 人 应 该 是 能 做 “所 有 事 ” 的 万 能 机 器 ， 
因此 这 种 机 器 人 在 大 量 出 售 以 后 价格 将 相对 便宜 。 但 是 ， 许多 机 器 人 的 实际 情况 则 恰好 与 之 相反 。 

我 认为 机 器 人 的 概念 应 该 与 在 给 定 的 时 间 内 什么 活动 是 与 人 相关 ， 以 及 什么 活动 是 与 机 器 相关 联系 起 来 。 
如 果 一 台 机 器 突然 变 得 能 够 完成 我 们 通常 和 人 联系 在 一 起 的 工作 时 ， 这 人 台 机 器 就 能 在 定义 上 被 提升 而 定义 为 一 
个 机 器 人 。 过 了 一 段 时 间 以 后 ， 人 们 习惯 于 这 件 工作 由 机 器 来 完成 了 ， 这 个 装置 就 从 “机 器 人 ”降级 为 “机 
器 ”。 那 些 没有 固定 底座 和 那些 具有 胎 膊 或 腿 状 附件 的 机 器 人 更 有 优势 ， 也 更 有 可 能 被 称 作 机 器 人 ， 但 是 很 难 
让 人 想到 一 套 始 终 如 一 的 定义 标准 ， 并 适合 目前 所 有 的 命名 惯例 。 

在 包括 家 用 机 器 的 所 有 机 器 中 ， 拥 有 微 处 理 器 来 指导 其 行动 的 都 可 以 认为 是 机 器 八 。 除了 真空 豚 尘 器 ， 还 
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有 洗衣 机 、 冰 箱 以 及 洗 碗 机 都 能 很 容易 地 作为 机 器 人 被 推 向 市 场 。 当 然 ， 还 存在 着 很 多 的 可 能 性 ， 包 括 那些 共 
有 环境 感知 反馈 和 判断 能 力 的 机 器 。 在 实践 里 ， 那 些 被 看 做 是 机 器 人 的 装置 中 ， 传 感 器 的 数量 和 判断 能 力 可 能 
由 很 多 、 很 强 一 直 变 化 到 完全 没有 。 

在 最 近 的 几 十 年 里 ， 对 机 器 人 的 研究 已 经 由 一 个 以 机 电 整 合 装置 研究 为 中 心 的 学 科 壮 大 为 一 个 宽广 得 多 的 
交叉 性 学 科 。 被 称 作 以 人 为 本 的 机 器 人 领域 便 是 这 样 的 一 个 例子 。 在 这 个 领域 里 ， 人 们 研究 人 和 智能 机 器 的 相 
互 作用 。 这 是 一 个 发 展 中 的 领域 ， 其 中 ， 对 机 器 人 与 人 的 相互 影响 的 研究 已 经 及 引 了 来 自 经 典 机 器 人 研究 领域 
之 外 的 专家 们 。 人 们 正在 研究 一 些 诸如 人 和 机 器 人 的 情感 之 类 的 概念 ; 而 且 一 些 像 人 体 生 理学 和 生物 学 等 古老 
的 研究 领域 正在 被 合并 成 机 器 人 研究 的 主流 。 这 些 研究 活动 将 新 的 工程 和 科学 层面 引进 到 了 研究 著述 中 ， 从 而 
丰富 了 机 器 人 研究 领域 。 

最 初 ， 初 期 的 机 器 人 界 主 要 关注 让 机 器 去 干 活 。 对 于 那些 早期 的 机 器 人 装置 ， 人 们 完全 只 关注 它们 能 不 能 
和 干 活 ， 而 很 少 去 在 意 它 们 有 限 的 性 能 。 现 在 ， 我 们 拥有 精细 的 、 可 靠 的 装置 作为 机 器 人 系统 现代 阵列 的 一 部 
分 。 这 一 进步 是 全 世界 成 千 上 万 人 的 工作 成 果 ， 这些 工 作 很 多 都 是 在 大 学 、 政 府 的 研究 实验 室 和 企业 里 进行 
的 。 这 一 成 就 创造 了 包含 在 本 手册 64 章 中 的 大 量 的 信息 ， 这 是 对 全 世界 工程 界 和 科学 界 的 致敬 。 显 然 这 些 成 
果 并 非 由 任何 中 央 规 划 或 者 一 个 整体 有 序 的 计划 产生 。 因 此 本 手册 的 编者 面 对 着 将 这 些 材料 组 织 成 一 个 有 逮 辑 
而 且 清 晰 明了 的 整体 的 艰巨 任务 。 

编辑 将 稿件 划分 为 三 层 结 构 。 第 一 层 论述 这 门 学 科 的 基础 。 这 一 层 由 9 章 组 成 。 作 者 在 其 中 详细 讲述 了 机 
器 人 学 科 、 运 动 学 、 动 力学 、 控 制 学 、 机 构 学 、 架 构 、 编 程 、 推 理 和 传 感 。 这 些 是 组 成 机 器 人 研究 和 发 展 的 基 
本 技术 。 

第 二 层 有 四 个 部 分 。 第 一 部 分 (第 2 篇) 阐述 了 机 器 人 的 结构 ， 包 括 尼 部 、 爵 、 手 和 其 他 大 多 数 机 器 人 
的 组 成 部 分 。 和 车 一 看 ， 腿 、 臂 部 和 手 这 些 硬件 可 能 相互 之 间 差 异 巨大 ， 但 它们 共有 一 套 属 性 ， 使 他 们 能 够 用 相 
同 的 或 很 接近 的 、 在 第 一 层 中 描述 过 的 原理 去 分 析 。 

该 层 的 第 二 部 分 (第 3 篇 ) 涉及 传 感 和 感知 ， 它 们 是 任何 真正 独立 的 机 妖 人 系统 所 必需 的 基本 能 力 。 正 
如 先前 指出 ， 实 际 上 许多 所 谓 的 机 器 人 设备 只 有 少量 的 上 述 能 力 ， 但 显然 更 先进 的 机 器 人 不 能 离开 它们 ， 并 且 
很 大 趋势 是 把 这 些 能 力 合并 到 机 器 人 设备 中 。 该 层 第 三 部 分 (第 4 篇 ) 讲述 了 这 门 学 科 领 域 和 设备 控制 与 接 
口技 术 的 联系 。 该 层 第 四 都 分 (第 5 篇 ) 由 8 章 组 成 ， 探 讨 了 移动 机 器 人 和 不 同形 式 的 分 布 式 机 器 人 。 

第 三 层 由 两 部 分 共 12 章 组 成 ， 涉 及 当今 研究 和 开发 前 沿 的 高 级 应 用 。 一 部 分 (第 6 篇 ) 论述 现场 和 服务 
机 器 人 ， 另 一 部 分 (第 7 篇 ) 讲述 以 人 为 本 和 仿真 机 器 人 。 对 于 外 行 读者 ， 这 些 章节 是 先进 机 器 人 的 全 部 。 
然而 必须 意识 到 这 些 非 同 寻常 的 实现 如 果 没有 前 两 层 所 介绍 的 发 展 ， 就 可 能 不 会 存在 。 

理论 和 实践 的 紧密 联系 促成 了 机 器 人 技术 的 发 展 ， 并 成 为 现代 机 器 人 的 一 种 特征 。 这 两 个 互补 的 方面 ， 双 
于 我 们 当中 那些 同时 拥有 机 会 研究 和 开发 机 器 人 设备 的 人 ， 是 个 人 成 就 感 的 源泉 。 本 手册 极 好 地 反映 了 学 科 的 
这 两 个 互补 方面 ， 并 展现 近 五 十 年 来 的 大 量 研究 成 果 。 一 些 人 将 要 发 明 更 有 能 力 的 多 样 的 下 一 代 机 器 人 设备 ， 
当然 ， 本 手册 的 内 容 将 作为 他 们 一 个 有 价值 的 工具 和 导 引 。 向 编辑 和 作者 致 以 祝贺 与 崇敬 。 


Rernard Roth 
美国 斯 坦 福 大 学 
2007 年 8 月 
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翻 开 这 本 和 手册， 纵 观 其 64 章 丰 富 的 内 容 ， 我 们 不 妨 从 个 人 的 视角 ， 对 机 
路人 学 在 概 您、 趋势 及 中 心 问题 等 方面 的 演变 作 一 个 概述 。 

现代 机 器 人 学 大 约 开 始 于 半 个 世纪 以 前 ， 并 向 两 个 不 同 的 方向 发 展 。 

首先 ， 让 我 们 了 解 一 下 机 械 臂 涉及 的 范围 ， 从 对 遭受 辐射 污染 产品 的 远 
程 作 业 到 工业 机 械 手 ， 无 不 包含 在 其 领域 中 ， 而 这 之 中 标志 性 机 器 UNIMATE 
是 通用 机 械 手 的 代表 。 产 品 的 工业 发 展 ， 大 多 围绕 六 自由 度 串 联 图 景 以 及 积 
极 的 研究 和 开发 ， 将 机 械 工程 与 控制 专业 化 联系 在 一 起 ， 成 为 其 发 展 的 主要 
推动 力 。 当 今 特别 值得 关注 的 是 ， 通 过 对 先进 的 功能 强大 的 数学 工具 的 运用 ， 
在 新 疾 的 应 用 优化 结构 设计 方面 的 努力 终于 获得 了 回报 。 类 似 的 ， 为 实现 制 
造 出 与 人 类 友好 的 机 器 人 的 梦想 ， 一 项 关于 未 来 认 知 机 器 人 的 辟 和 手 的 设计 Georges Giralt 
与 实际 建造 也 引起 了 人 们 的 重视 。 研究 主管 

其 次 ， 还 未 被 人 类 充分 认识 但 我 们 应 该 清楚 的 是 涉及 人 工 智能 相关 主题 ”法国 拉 斯 -国家 科学 研究 中 心 
的 系列 工作 。 在 此 领域 中 具有 里 程 碑 意义 的 项 目 便 是 斯 坦 福 国际 集团 开发 的 (LAAS- CNRS) ， 图 卢 效 
移动 机 器 人 Shakey。 这 项 旨 在 集 计算 机 科学 、 人 工 智 能 和 应 用 数学 于 一 身 发 
展 智能 机 器 的 工作 ， 至 今 作为 一 个 子 领域 已 经 有 一 段 时 间 了 。20 世纪 80 年代 期 间 ， 通 过 对 围绕 包括 从 极端 环 
境 下 的 探测 器 (如 星球 探测 ， 南 极 洲 等 ) 到 服务 机 器 人 (如 医院 ， 博 物 馆 引 导 等 ) 等 宽广 范围 的 个 案 研究 获 
得 的 建设 强度 ， 引 发 了 大 范围 的 研究 ， 从 而 也 葛 定 了 管 能 机 器 人 的 地 位 。 

因此 机 器 人 学 的 研究 能 够 将 这 两 个 不 同 的 分 支 联 系 起 来 ， 将 智能 机 器 人 以 一 种 纯粹 的 计算 方式 分 类 为 有 限 
理性 机 器 ， 这 是 在 20 世纪 80 年 代 第 三 代 机 器 人 定义 的 基础 上 进行 了 扩展 : 

“ (WRA) eee 作为 一 个 通过 智能 将 感知 和 行动 联系 在 一 起 ， 而 被 赋予 了 对 一 项 工作 拥有 理解 、 推 断 并 
执行 能 力 的 机 器 ， 在 三 维 的 世界 里 执行 操作 。” 

作为 一 个 广泛 认可 的 测试 平台 ， 自 主机 器 人 领域 最 近 从 机 器 人 设计 方面 的 突出 贡献 中 受益 颇 多 ， 而 这 些 贡 
献 是 通过 在 环境 建 模 及 机 器 人 定位 上 运用 算法 儿 何 及 随机 框架 法 (SLAM, EFEMER), UREA I 
斯 估计 和 决策 方法 所 带 来 的 决策 程序 的 发 展 等 综合 取得 的 。 

在 千 禧 年 的 过 去 十 年 间 ， 机 器 人 学 主要 处 理智 能 机 器 人 图 景 ， 在 一 个 覆盖 了 先进 传 感 和 知觉 、 任 务 推理 和 
规划、 操作 和 决策 自动 化 、 功 能 性 整合 架构 、 管 能 人 机 接口 、 安 全 和 可 靠 性 等 项 目的 主题 和 内， 将 机 妖 人 和 机 器 
智能 通用 研究 结合 起 来 。 

第 二 个 分 支 数 年 来 被 认为 是 非 制造 机 器 人 学 的 ， 涉 及 大 量 有 关 现 场 、 服 务 、 辅 助 以 及 后 来 的 个 人 机 器 人 
的 、 以 研究 为 驱动 的 真实 世界 的 案例 。 这 里 ， 机 器 智能 在 其 多 个 主题 内 是 中 心 研究 方向 ， 使 得 机 器 人 能 够 在 以 
下 三 个 方面 得 以 行动 : 

1) 作为 人 类 的 替代 者 ， 尤 其 是 对 于 远程 或 恶劣 环境 中 的 干预 工作 。 

2) 通过 与 人 友好 机 器 人 学 或 以 人 为 本 机 器 人 学 的 所 有 实际 应 用 ,与 人 类 的 亲近 交互 及 在 人 类 环境 中 的 
操作 。 

3) 与 使 用 者 的 紧密 协同 ， 从 机 械 外 骨 能 辅助 、 外 科 手 术 、 保 健 各 康复 扩展 到 人 类 隆胸 。 

因此 ， 在 千年 之 交 ， 机 器 人 学 已 经 成 为 一 个 广泛 的 研究 主题 ， 不 仅 有 对 于 工程 化 很 好 的 工业 领域 支持 市 场 
产品 ， 同 时 也 有 大 量 在 危险 环境 中 操作 的 领域 导向 的 应 用 案例 ， 如 水 下 机 上 器 人 、 复 杂 地 形 车 、 医 疗 / 康 复 机 痪 
人 学 等 。 

机 器 人 学 的 发 展 水 平 重 点 看 理论 方面 所 扮演 的 角色 ， 目 前 它 已 经 从 应 用 领域 发 展 到 技术 和 科学 的 领域 。 这 
本 手册 的 组 织 构 架 很 好 地 阔 释 了 这 些 不 同 的 水 平 。 此 外 ， 为 了 未 来 认 知 型 机 器 人 ， 除 了 大 量 的 软件 系统 ， 人 们 
还 需要 考虑 与 人 友好 的 环境 中 的 机 器 人 物理 性 质 和 新 奇 附 件 ， 包 括 腊 、 沉 和 和 手 的 设计 。 
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在 当前 千 禧 年 的 前 十 年 ， 前 沿 的 机 器 人 学 正在 取得 突出 的 进步 ， 通 常 由 以 下 两 个 方向 组 成 : 

1) 中 /短期 面向 应 用 的 案例 研究 。 

2) 中 /长 期 一 般 情况 的 研究 。 

为 了 完整 性 ， 我 们 需要 提 到 大 量 外 围 的 、 激 发 机 器 人 学 灵感 的 学 科 ， 这 些 学 科 经 常 是 关于 娱乐 、 广 告 和 精 
致 的 玩具 。 l 

与 人 友好 机 器 人 学 的 前 沿 领域 包括 儿 个 一 线 的 应 用 领域 ， 在 这 些 领 域 里 ， 机 器 人 (娱乐 、 教 育 、 公 共 服 
务 、 辅 助 和 个 人 机 器 人 等 ) 在 人 类 环境 或 者 在 和 人 类 密切 相互 作用 的 环境 里 运作 。 这 里 也 就 介绍 了 人 机 交互 
的 关键 性 问题 。 

正 是 在 这 个 领域 的 中 心 ， 浮 现 出 来 个 人 机 器 人 的 前 沿 的 课题 ， 对 此 ， 在 这 里 我 们 着 重 强调 它 的 三 个 总 体 
特征 : 

1) 它们 可 能 由 非 专业 使 用 者 操作 。 

2) 它们 可 能 被 设计 来 和 使 用 者 分 享 高 水 平 的 决定 。 

3) 它们 可 能 包含 环境 装置 和 机 器 附件 、 遥 远 的 系统 ,还 有 操作 者 。 这 种 分 享 决策 的 观念 暗示 这 里 呈现 出 
一 些 前 治 研究 课题 和 伦理 问题 。 

个 人 机 器 人 的 概念 ， 正 扩大 为 机 器 人 助手 和 万 能 “ 伴 但 ”， 对 于 机 器 人 学 来 说 确实 是 一 项 重大 的 挑战 。 机 
器 人 学 作为 科学 和 技术 领域 的 一 个 重要 分 支 ， 提 供 了 在 中 长 期 对 社会 和 经 济 产 生 重大 影响 的 观念 。 这 里 介绍 各 
质疑 前 沿 课题 包括 以 下 认 知 的 方面 : 可 协调 的 智能 人 机 交互 、 感 觉 (场景 分 析 、 种 类 识别 ) 、 开 放 式 学 习 《 了 
解 所 有 的 行为 )、 技 能 获取 、 大 量 的 机 器 人 世界 的 数据 处 理 、 自 主 决定 权 和 可 靠 性 (安全 性 、 可 靠 性 、 交 流 和 
操作 稳定 性 ) 。 

上 面 提 到 的 两 种 方法 有 很 明显 的 协同 性 ， 尽 管 必 要 的 框架 存在 时 差 。 这 种 科学 上 的 联系 不 仅 集合 了 问题 和 
获得 结果 ， 而且 也 在 事物 两 方面 创造 出 和 谐 的 交流 和 给 技术 带 来 进步 。 

事实 上 ， 这 种 相应 的 研究 趋势 和 应 用 领域 的 发 展 获得 了 爆炸 性 的 实用 技术 的 支持 ， 其 中 包括 计算 机 处 理 能 
力 、 通 信 学 、 计 算 机 网 络 设计 、 传 感 装 置 、 知 识 检索 、 新 材料 、 微 纳米 技术 。 

今天 ， 展 望 中 长 期 的 未 来 ， 我 们 正面 对 非常 积极 的 议题 和 观点 ， 但 是 也 必须 对 有 关机 器 人 的 批评 性 意见 和 
隐 存 的 风险 做 出 回应 ， 这 种 风险 就 在 于 人 们 担心 机 器 人 在 和 人 接触 的 过 程 中 也 可 能 出 现 不 需要 的 或 者 不 安全 的 
行为 。 因 此 ， 存 在 一 个 非常 清晰 的 需求 ， 那 就 是 研究 级 别 安全 问题 和 可 靠 性 与 相应 的 系统 限制 课题 。 

《机 器 人 手册 》 的 出 版 非常 及 时 ， 充 满 了 挑战 性 的 成 果 。 它 由 165 位 作者 在 64 章 中 总 结 了 大 量 的 难题 、 问 
题 和 方方面面 。 就 其 本 身 而 言 ， 它 不 仅 是 全 世界 研究 者 所 获得 的 基本 课题 和 结果 的 一 个 高 效 展示 ， 而 且 进一步 
纷 每 二 个 人 提供 了 不 同 的 观点 和 方法 。 这 确实 是 一 个 可 以 带 来 进步 的 很 重要 的 工具 ， 但 是 ， 更 重要 的 是 ， 它 将 
在 这 个 千 禧 年 的 头 二 十 年 成 为 建立 机 器 人 学 的 开端 ， 在 机 器 智能 的 核心 领域 成 为 科学 的 学 科 。 
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机 器 人 学 领域 诞生 于 20 世纪 中 期 ， 当 时 新 兴 的 计算 机 科学 正在 改变 科学 
和 工程 中 的 每 一 个 领域 。 机 器 人 学 经 历 了 不 同 的 阶段 ， 从 婴儿 期 ， 童 年 期 到 
青年 期 ， 再 到 成 年 期 ， 已 经 完成 了 快速 而 稳健 的 成 长 。 机 器 人 学 现在 已 经 成 
熟 ， 人 们 希望 它 在 未 来 的 社会 里 提高 他 们 的 生活 质量 。 

在 机 器 人 学 的 贾 儿 期 ， 它 的 核心 被 认为 是 模式 识别 、 自 动 控制 和 人 工 智 
能 。 带 着 这 些 新 的 挑战 ， 这 个 领域 的 科学 家 和 工程 师 聚 集 在 一 起 来 审查 新 奇 
的 机 器 人 传感器 和 驱动 器 、 规 划 和 编程 算法 以 及 连接 各 部 分 组 件 的 最 优 结构 。 
在 此 过 程 中 ， 他 们 创造 出 在 真实 世界 中 可 以 和 人 进行 交互 作用 的 机 器 人 。 这 
些 旱 期 的 机 器 人 学 集中 于 研究 手 - 腿 系统 ， 也 就 是 人 工 智 能 研究 的 试验 平台 。 

“童年 时 期 ”机 器 人 的 活动 场地 是 在 工厂 。 工 业 机 器 人 被 研究 出 来 ， 并 Hirochtia Tione 
且 应 用 到 工厂 进行 自动 喷涂 、 点 焊 、 打 磨 、 材 料 操作 和 零件 装配 。 拥 有 传 感 日 本 东京 大 学 教授 
器 和 记忆 功能 的 机 器 人 使 工厂 更 加 自动 化 ， 使 机 器 人 的 操作 更 加 柔性 化 、 更 
加 可 靠 和 精确 。 机 器 人 的 自动 化 将 人 从 繁重 和 乏味 的 体力 劳动 中 解放 出 来 。 汽 车 、 家 电 和 和 半导体 工业 迅速 将 其 
生产 线 重 整 为 机 器 人 集成 化 系统 。 英 文 单词 “机 械 电 子 ”( 又 称 为 “机 电 一 体 化 "、“ 电 子 机 械 ”) 最 早 是 由 日 
本 人 在 20 世纪 70 年 代 末 期 提出 来 的 。 它 定义 了 一 个 新 的 机 器 观念 ， 在 这 种 观念 里 ， 电 子 和 机 器 系统 相 融 合 ， 
这 种 融合 使 很 多 工业 产品 变 得 更 加 简单 、 却 又 更 加 多 功能 ， 而 且 可 编程 和 智能 化 。 机 器 人 学 和 机 械 电 子 学 在 制 
造 过 程 的 设计 、 操 作 和 工业 产品 上 都 产生 了 非常 积极 的 影响 。 

随 着 机 器 人 学 进入 它 的 青春 期 ， 研 究 者 雄心 勃勃 地 去 探索 它 新 的 起 点 。 运 动 学 、 动 力学 和 系统 控制 理论 变 
得 更 加 精妙 ， 同 时 它们 也 被 应 用 到 真正 的 复杂 机 器 人 的 机 构 中 。 为 了 进行 规划 和 完成 真实 的 任务 ， 机 器 人 必须 
能 够 认 知 它 所 处 的 环境 。 视觉 一 一 外 部 感觉 的 主要 的 途径 ， 作 为 机 器 人 了 解 其 所 处 外 部 环境 的 最 普通 、 最 有 效 
的 、 最 高 效 的 手段 ， 被 开发 出 来 。 已 经 发 展 起 来 的 高 级 的 算法 和 强 有 力 的 装置 将 会 用 来 提高 机 器 人 视觉 系统 的 
速度 和 稳定 性 。 触 觉 和 力 的 传 感 系统 也 需要 发 展 ， 这 样机 器 人 可 以 更 好 地 操控 物体 。 在 建 模 、 规 划 、 认 知 、 推 
理 和 记忆 方面 的 研究 扩大 了 机 器 人 的 智能 化 特性 。 机 器 人 学 逐渐 被 定义 为 传 感 和 了 驱动 之 间 的 智能 连接 的 研究 。 
这 种 定义 覆盖 了 机 器 人 学 的 所 有 方面 : 三 大 科学 核心 和 一 个 整合 它们 的 综合 方法 。 事 实 上 ， 由 于 系统 综合 使 仿 
生机 器 的 创造 成 为 可 能 ， 所 以 它 已 经 成 为 一 个 机 器 人 工程 的 关键 性 方面 。 创 造 这 种 仿生 机 哈 人 的 乐趣 豚 引 了 很 
多 学 生 投 身 到 机 器 人 学 领域 。 

在 发 展 机 器 人 学 的 过 程 中 ， 科 学 的 兴趣 被 导向 到 去 理解 人 类 的 精妙 。 人 类 和 机 器 人 的 比较 研究 在 科学 研究 
人 的 功能 建 模 方 面 开 入 出 了 一 条 新 路 。 认 知 机 器 人 学 、 仿 生 行 为 、 生 物 激发 的 机 器 人 和 机 器 人 生理 心理 学 方 
法 ， 在 扩大 机 器 人 洪 力 方面 达到 了 极限 。 总 的 来 说 ， 在 科学 探索 中 ， 不 成 熟 的 领域 是 稀少 的 。20 世纪 80 和 90 
年 代 ， 机 器 人 学 就 处 于 这 样 一 个 年 轻 的 阶段 ， 它 贤 引 了 大 量 充满 好 奇 心 的 研究 者 进入 这 个 新 的 前 沿 领域 。 他 们 
对 该 领域 持续 的 探索 形成 该 本 富 食 科学 内 容 的 综合 性 手册 。 

随 着 机 器 人 学 科 前 沿 知识 的 掌握 ， 进 一 步 的 挑战 为 我 们 打开 了 将 成 熟 的 机 器 人 技术 应 用 于 实际 的 大 门 。 早 
期 的 机 器 人 的 活动 空间 给 工业 机 器 人 的 场所 让 路 。 内 科 机 器 人 、 外 科 机 器 人 人、 活体 成 像 技 术 给 医生 做 手术 提供 
了 强 有 力 的 工具 ， 这 使 许多 病人 免 于 病痛 的 折磨 。 人 们 期 望 诸 如 康复 、 卫 生 保 健 、 福 利 领域 的 新 机 器 人 能 够 提 
高 老龄 化 社会 的 生活 质量 。 机 器 人 必 将 会 遍布 于 世界 的 每 一 个 角落 一 一 天 上 、 水 下 、 太 空中 。 人 们 希望 能 和 机 
器 人 在 农业 、 林 业 、 矿 业 、 建 筑 业 、 危 险 环 境 及 救援 中 联手 工作 ， 并 发 现 机 器 人 在 家 务 及 在 商店 、 饭 馆 、 医 院 
服务 中 的 实用 性 。 在 无 数 的 方式 中 ， 人 们 还 是 希望 机 器 人 可 以 支持 我 们 的 生活 。 然 而 ， 从 这 方面 来 看 ， 机 器 人 
的 应 用 主要 受到 结构 化 环境 的 限制 ， 在 这 些 环 境 中 ， 出 于 安全 考虑 ， 机 器 人 和 人 是 相互 隔离 的 。 在 下 一 个 阶 
段 ， 机 器 人 所 处 的 环境 将 扩展 为 非 结构 化 的 世界 ， 在 这 里 ， 人 享受 服务 ， 将 总 是 和 机 器 人 一 起 工作 和 生活 。 在 
这 样 的 环境 中 ， 机 器 人 将 必须 具备 高 性 能 的 传感器 、 更 加 智能 化 、 强 化 的 安全 性 和 更 好 的 人 类 理解 力 。 在 寻求 
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阻碍 机 器 人 发 展 问题 的 解答 过 程 中 ， 不 仅 应 该 考虑 技术 上 的 问题 ， 还 应 该 考虑 社会 问题 。 

目 从 我 最 初 的 研究 一 一 使 机 器 人 变 成 一 个 奇想 ， 到 现在 ， 四 十 年 已 经 过 去 了 。 从 最 开始 就 见证 了 机 器 人 技 
术 的 成 长 我 感到 幸运 和 高 兴 。 为 了 机 器 人 学 的 诞生 ， 从 其 他 学 科 引 进 了 基础 的 技术 。 没 有 教科 书 和 手册 是 现成 
的 。 为 了 达到 目前 的 这 个 阶段 ， 许 多 科学 家 和 工程 师 已 经 挑战 了 新 的 领域 。 在 推进 机 器 人 学 的 同时 ， 他 们 从 多 
维度 的 视角 丰富 了 知识 本 身 。 他 们 努力 的 成 果 都 已 经 编辑 在 这 本 机 器 人 手册 中 了 。 这 本 出 版 物 是 百 多 位 世界 令 
年 专家 共同 合作 的 结果 。 现 在 ， 那 些 希望 投身 于 机 器 人 学 研究 的 人 就 能 够 找到 一 个 可 以 建构 自己 知识 体系 的 坚 
实 的 基础 。 这 本 手册 必 将 会 用 于 进一步 发 展 机 器 人 学 ， 强 化 的 工程 教育 和 系统 的 知识 编辑 可 以 促进 社会 和 工业 
的 知识 创新 。 

在 老龄 化 社会 里 ， 人 类 和 机 器 人 的 角色 是 科学 家 和 工程 师 需 要 考虑 的 重要 问题 。 机 器 人 能 够 对 保卫 和 平 、 
促进 繁荣 和 提高 人 们 生活 质量 做 出 贡献 吗 ? 这 是 一 个 尚未 解决 的 问题 。 然 而 ， 最近 个 人 机 器 人 、 家 用 机 器 人 和 
仿 人 机 器 人 的 进步 间接 表明 机 器 人 从 工业 部 门 到 服务 业 部 门 的 转移 。 为 了 实现 这 种 转移 ， 机 器 人 学 不 可 回避 这 
样 的 观点 ， 那 就 是 机 器 人 学 工作 的 基础 包含 了 社会 学 、 生 理 心理 学 、 法 律 、 经 济 、 保 险 、 伦 理 、 艺 术 、 设 计 、 
戏剧 和 和 运动 科学 。 将 来 的 机 器 人 学 应 该 被 作为 包含 人 类 学 和 技术 的 学 科 来 研究 。 这 本 手册 有 选择 地 提供 了 推进 
机 器 人 学 这 个 新 兴 科 学 领域 的 技术 基础 。 我 期 待机 器 人 学 持续 不 断 的 进步 ， 期 待 它 能 够 促进 未 来 社会 的 繁荣 。 
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机 器 人 已 经 让 人 类 着 迷 了 几 千 年 。 在 20 世纪 之 前 制造 的 机 器 人 没有 
将 传 感 和 动作 联系 起 来 ， 只 是 通过 人 力 或 者 是 重复 性 的 机 器 来 驱动 。 直 
到 20 世纪 20 年代， 电子 登 上 舞台 之 后 ， 才 制造 出 了 第 一 台 真 正 感知 世 
界 并 能 恰当 工作 的 机 器 人 。 在 1950 年 前 ， 我 们 开始 看 到 流行 杂志 中 出 现 
了 对 真正 机 器 人 的 描述 。20 世纪 60 年 代 ， 工 业 机 器 人 进入 了 人 们 的 视 
野 。 商 业 压 力 迫 使 它们 对 环境 越 来 越 不 敏感 ， 而 在 它们 自己 的 工程 化 世 
界 中 ,动作 却 越 来 越 快 。20 世纪 70 年 代 中 期 ， 在 法 国 、 日 本 和 美国 ， 机 
器 人 再 一 次 在 少数 研究 实验 室 出 现 。 现 在 我 们 已 经 迎 来 了 一 个 世界 性 的 
研究 热潮 和 遍布 世界 的 智能 机 器 人 大 规模 研究 的 莲 勃 发 展 。 本 手册 汇集 





Rodney Brooks 
了 目前 多 个 领域 机 器 人 的 研究 现状 。 从 机 器 人 的 机 械 装 置 、 感 应 和 知 党 美国 麻 省 理工 学 院 布鲁克 斯 教授 


处 理 、 智 能 、 动 作 到 许多 应 用 领域 ， 本 书 都 有 涉及 。 


我 非常 幸运 地 生活 在 过 去 30 年 来 机 器 人 的 研究 革命 之 中 。 在 澳大利亚 ， 当 我 还 是 一 个 少年 的 时 候 ， 在 
1949 年 和 1950 年 我 受到 Walter 在 《科学 美国 人 》 中 所 描述 的 乌龟 的 启发 ,制作 了 一 个 机 器 人 。 当 我 在 1977 
年 抵达 硅谷 时 ， 怡 好 是 计算 机 个 人 化 革命 真正 开始 的 时 候 ， 但 是 我 转向 了 更 为 模糊 的 机 器 人 世界 的 研究 当中 。 
在 1979 年 我 已 经 可 以 协助 斯 坦 福 人 工 智能 实验 室 (SAIL) 的 Hans Moravec 工作 了 ， 当 时 他 正在 耐心 地 使 他 的 
机 器 人 “The Cart” 在 6 个 小 时 之 内 行驶 20 米 。 就 在 26 年 之 后 的 2005 年 ， 在 同样 的 实验 室 一 一 斯 坦 福 人 工 条 
能 实验 室 ，Sebastian Thrun 和 他 的 团队 已 经 可 以 使 机 器 人 在 6 个 小 时 之 内 自动 行驶 200000 米 了 ， 在 仅仅 26 年 
之 中 就 提高 了 4 个 数量 级 ， 比 每 两 年 就 翻 一 番 的 速度 还 快 一 上 点。 但是， 机 器 人 不 仅仅 是 在 速度 上 提升 了 ， 它 们 
在 数量 上 也 增加 了 。 我 在 1977 年 刚 到 斯 坦 福 人 工 智能 实验 室 的 时 候 ， 世 界 上 只 有 3 合 移动 机 器 人 在 运行 。 最 
近 ， 我 投资 建立 的 一 个 公司 制造 了 第 3000000 台 移 动机 器 人 ， 并 且 我 们 制造 的 步伐 还 在 加 快 。 机 器 人 的 其 他 领 
域 也 有 类 似 的 壮大 发 展 ， 尽 管 提 供 一 个 简洁 的 数字 化 的 描述 更 难 一 些 。 以 前 ， 机 器 人 太 不 清楚 它们 周围 的 环 
境 ， 所 以 人 们 和 机 器 人 近 上 距离 一 起 工作 非常 不 安全 ， 而 且 机 器 人 也 根本 意识 不 到 人 们 的 存在 。 但 是 近 些 年 ， 
我 们 已 经 远离 了 那样 的 机 器 人 ， 还 制造 出 了 可 以 从 人 们 的 面部 表情 和 声音 葛 律 当中 领悟 其 暗示 的 机 器 人 。 近 
期 ， 机 器 人 已 经 穿 过 了 肉体 和 机 器 的 界限 ， 所 以 现在 我 们 正在 看 到 一 系列 的 智能 机 器 人 人， 包括 从 会 修复 牵引 
术 的 机 器 人 到 为 残疾 人 设计 的 康复 机 器 人 。 最 近 ， 机 器 人 已 经 成 为 了 认 知 科学 和 智能 科学 研究 中 受 尊敬 的 贡 
献 者 。 

本 手册 介绍 的 研究 结果 提供 了 推动 机 器 人 伟大 进步 的 关键 想法 。 参 与 和 部 分 参与 工作 的 编辑 们 和 所 有 的 作 
者 把 这 些 知识 汇集 起 来 ， 完 成 了 一 项 一 流 的 工作 。 这 项 工作 将 会 为 机 器 人 的 进一步 研发 提供 基础 。 谢 谢 你 们 ， 
并 祝贺 所 有 在 这 项 关键 工作 中 付出 劳动 的 人 们 。 

对 一 些 未 来 机 器 人 的 研究 将 通过 采用 和 改善 技术 得 以 增加 。 未 来 机 器 人 研究 的 其 他 方面 将 会 更 具 革 命 性 ， 
这 些 研究 的 基础 会 与 一 些 观念 以 及 本 书 所 述 的 现 有 技术 发 展 水 平 相反 。 

当 你 在 研究 本 书 ， 寻 找 一 些 领 域 来 通过 你 自己 的 才华 和 努力 对 机 器 人 研究 做 出 贡献 的 时 候 ， 我 想 提 醒 你 ， 
我 相信 能 力 和 灵感 会 使 机 器 人 更 加 有 用 ， 更 加 高 产 ， 更 容易 被 接受 。 我 把 这 些 能 力 按照 一 个 小 孩子 拥有 同等 能 
力 时 的 年 龄 描述 为 : 

© 一 个 两 岁 小 孩子 的 物体 认 知 能 力 。 

e 一 个 四 岁 小 孩子 的 语言 能 力 。 
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© 一 个 六 岁 小 孩子 的 灵巧 能 力 。 

© 一 个 八 岁 小 孩子 的 社会 理解 能 力 。 

达到 上 述 每 一 个 程度 都 是 非常 困难 的 目标 。 但 是 即使 是 朝向 以 上 任何 一 个 目标 的 微小 进步 也 将 会 立即 应 用 
在 外 面世 界 的 机 器 人 上 。 当 你 进一步 对 机 器 人 学 有 所 贡献 之 时 ， 好 好 阅读 本 书 并 祝 你 好 运 。 


Rodney Brooks 
美国 麻 省 理工 学 院 ， 剑 桥 
2007 年 10 月 
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机 器 人 在 达到 人 类 前 沿 的 同时 ， 积 极 应 对 着 新 兴 领 域 中 出 现 的 各 种 挑战 。 新 一 代 机 器 人 和 人 类 互动 ， 和 人 
类 一 起 探索 、 工 作 ， 它 们 将 会 越 来 越 多 地 接触 人 类 及 其 生活 。 实用 机 器 人 的 前 景 令 人 信服 是 半 个 世纪 的 机 器 人 
科学 发 展 的 结果 ， 这 种 发 展 将 机 器 人 作为 现代 科学 学 科 建 立 起 来 。 

机 器 人 领域 的 快速 发 展 推动 了 这 本 《机 器 人 手册 》 的 诞生 。 随 着 期 刊 、 会 议论 文集 和 专著 的 增加 ， 参 与 
机 器 人 科学 技术 研究 的 人 ， 特 别 是 刚 进 入 该 领域 的 人 ， 很 难 跟 得 上 它 大 范围 发 展 的 脚步 。 由 于 机 器 人 技术 是 多 
学 科 交 叉 的 技术 ， 这 个 任务 就 显得 尤为 艰难 。 

这 本 手册 依据 20 世纪 80、90 年 代 机 器 人 学 的 发 展 成 果 ， 这 些 成 果 对 机 器 人 领域 的 研究 很 有 参考 价值 ; 
《机 器 人 策略 : 规划 和 控制 》(Brady，Hollerbach Johnson, Lozano- Perez， 和 Mason, MIT 出 版 社 ，1982) , 《机 
器 人 科学 》(Brady，MIT 出 版 社 ，1989) ， 机 器 人 评论 1 和 2 (Khatib, ，Craig， 和 Lozano- Pérez，MIT 出 版 社 ， 
1989 和 1992) 。 随 着 机 器 人 领域 更 大 的 扩展 以 及 向 其 他 学 科 的 日 渐 延 伸 ， 人 们 对 一 部 包含 机 器 人 基本 知识 和 先 
进发 展 的 综合 性 参考 手册 的 需求 越 来 越 强 烈 。 

这 本 手册 是 世界 各 国 多 位 积极 参与 机 器 人 研究 的 作者 的 努力 成 果 。 将 各 位 作者 组 织 成 一 个 目标 明确 、 能 力 
草 越 的 团队 ， 卓 有 见地 地 介绍 覆盖 机 器 人 各 个 领域 的 知识 ， 这 是 一 项 艰巨 的 任务 。 

这 个 工程 开始 于 2005 年 5 月 ,我 们 和 施 普 林 格 欧洲 工程 主管 Dieter Merkle 及 STAR 的 资深 编辑 Thomas 
Ditzinger 一 起 参加 会 议 期 间 。 一 年 以 前 ， 我 们 和 Frans Groen 一 道 发 行 了 “斯 普 林 格 先进 机 器 人 技术 ”系列 小 
册子 ， 这 个 小 册子 迅速 成 为 及 时 传播 机 器 人 技术 研究 信息 的 重要 媒介 。 

正 是 在 这 种 背景 下 ， 我 们 开始 了 这 个 具有 挑战 性 的 任务 ， 满 膝 热 情 地 开始 规划 开发 技术 结构 和 构建 作者 团 
队 。 我 们 构思 了 一 部 由 3 层 架 构 、 共 7 篇 内 容 的 手册 ， 在 机 器 人 领域 已 经 建立 了 的 学 术 中 心 、 目 前 正在 进行 的 
研发 ， 以 及 新 兴 应 用 中 获取 该 领域 多 层面 的 信息 。 

第 一 层 即 第 1 篇 是 机 器 人 学 基础 。 综 合 的 方法 和 技术 包含 在 第 二 层 的 四 篇 中 ,涵盖 了 机 器 人 的 结构 、 传 感 
和 感知 ， 操 作 和 接口 ， 移 动 和 分 布 式 机 器 人 。 第 三 层 ， 包 括 机 器 人 技术 在 两 个 领域 先进 的 应 用 ， 分 别 是 : 服务 
机 器 人 和 以 人 为 中 心 的 信人 机 器 人 。 

为 了 展开 上 述 各 部 分 ， 我 们 设想 建立 一 个 编辑 团队 ， 来 整理 作者 的 稿件 ， 以 组 成 各 个 章节 。 一 年 后 我 们 的 
七 人 编辑 团队 形成 了 : David Orin, Frank Park, Henrik Christensen, Makoto Kaneko, Raja Chatila, Alex Zelinsky 
和 Daniela Rus. 。 有 这 样 一 批 杰出 的 学 者 致力 于 这 个 手册 的 编辑 工作 ， 该 手册 在 学 术 领 域 一 定 是 高 质量 、 大 跨 
度 的 。 

到 2005 年 初 ， 我 们 的 作者 超过 了 1150 位 。 为 了 方便 内 部 以 及 各 个 章节 的 交叉 参照 ， 把 握手 册 的 编写 进 
Ke, 我们 制作 了 内 部 网 站 。 第 二 年 ， 就 认真 协调 了 手册 的 内 容 。 尤 其 是 在 2005 年 和 2006 年 春季 的 两 个 全 日 制 
举行 的 讲习 班 ， 大 部 分 作者 都 出 席 了 。 

本 手册 的 每 一 章 都 由 至 少 3 个 独立 的 审 稿 人 员 进 行 审 稿 ， 通 常 都 会 包括 那 一 章 的 编辑 和 两 位 相关 章节 的 作 
者 ， 有 时 候 也 会 由 一 些 该 领域 的 其 他 专家 进行 审阅 。 必 须 审 读 两 遍 ， 有 时 候 甚至 是 三 遍 。 在 这 个 过 程 中 ， 只 要 
认为 有 必要 ， 就 会 加 入 几 位 新 的 作者 。 本 书 大 部 分 章节 在 2007 年 夏季 之 前 已 定稿 ， 在 2008 年 早春 之 前 书稿 已 
全 部 完成 一 一 那 时 候 ， 我 们 收 到 了 10000 多 份 电子 邮件 ， 汇 集 了 来 自 165 位 作者 的 7 篇 总 共 64 章 1650 多 页 的 
内 容 ， 有 950 is, 5500 篇 参考 文献 。 

我 们 对 作者 们 的 脑力 劳动 深 表 谢意 ， 也 同样 感谢 审 稿 人 员 和 和 各 部 分 编辑 的 尽职 尽责 。 感谢“ 施 普 林 格 科 
学 和 工程 手册 ”的 高 级 经 理 Wemer Skolaut， 他 全 力 支 持 稿 件 的 编辑 加 工 工作 ， 将 手册 的 编辑 和 审 稿 、 出 版 相 
结合 ， 很 快 成 为 了 我 们 团队 很 投入 的 一 名 队员 。 感 谢 Le-TeX 的 工作 人 员 的 高 度 专 业 化 的 工作 ， 他 们 重新 排版 
了 所 有 的 文字 ， 重 绘 和 完善 了 很 多 图 稿 ， 同 时 在 校对 材料 时 及 时 地 和 和 作者 互动 。 
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在 出 版 手册 这 个 想法 产生 六 年 之 后 ， 这 本 手册 终于 面世 了 。 除 了 它 对 研究 人 员 的 指导 意义 以 外 ， 我 们 也 
希望 这 本 手册 能 够 又 引 一 些 新 的 研究 者 进入 机 器 人 领域 ， 激 励 这 个 充满 魅力 的 领域 几 十 年 的 莲 勃 发 展 。 每 一 
次 努力 的 完成 ， 总 会 带 来 新 的 令 人 振奋 的 挑战 。 在 这 种 时 候 我 们 都 会 提醒 我 们 的 研究 员 一 保持 前 进 的 
梯度 。 





Bruno Siciliano 

Oussama Khatib 

意大利 那不勒斯 、 美 国 斯 坦 福 大 学 
2008 年 4 月 
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引 


Bruno Siciliano, Oussama Khatib 


机 器 人 ! 火星、 海洋、 医院、 家庭、 工厂 、 学 
校 ， 机 器 人 无 处 不 在 。 机 器 人 能 够 救火 ， 能 够 制造 产 
品 ， 能 够 节约 时 间 、 挽 救生 命 …… 现 如 今 ， 从 制造 
业 ， 到 医疗 保健 、 交 通 运 输 以 及 对 外 层 空间 和 深海 的 
探索 ， 机 器 人 正在 对 现代 生活 的 许多 方面 产生 着 相当 
大 的 影响 。 未 来 ， 机 器 人 将 会 和 现在 的 个 人 电脑 一 样 
普及 和 私人 化 。 从 一 开始 ， 人 们 就 梦想 着 能 创造 出 既 
有 能 力 又 有 智慧 的 机 器 。 现 在 这 个 梦想 在 我 们 的 世界 
里 已 经 部 分 成 为 现实 。 

从 早期 文明 开始 ， 人 类 最 大 的 雄心 之 一 就 是 要 创 
造 出 他 们 想象 中 的 物品 。 将 人 类 从 粘土 中 塑造 出 来 的 
巨神 普罗 米 修 斯 或 是 赫 淮 斯 托 斯 锻造 的 青铜 奴役 巨人 
泰勒 斯 (公元 前 3500 年 ) 的 传奇 ， 证 明了 希腊 神话 
的 这 种 追求 。 埃 及 人 的 甲骨 文中 的 神 论 (公元 前 
2500 年 ) 也 许 正 是 现代 思维 机 器 的 先驱 。 巴 比 伦 人 
制造 的 漏水 计时 器 (公元 前 1400) 是 最 早 的 自动 机 
械 装 置 之 一 。 在 以 后 的 几 个 世纪 里 ， 人 类 的 创造 力 造 
就 出 许多 装置 ， 例 如 ， 有 自动 装置 的 英雄 亚历山大 剧 
Be (100 年 ) 、 加 扎 里 (1200 Æ) 的 水 力 灌溉 和 类 人 
机 器 ， 以 及 芋 昂 纳 多 - 达 芬 奇 的 难以 计数 的 极 具 创 造 
性 的 设计 (1500 年 )。 在 18 世纪， 自动 控制 技术 继 
续 在 欧洲 和 亚洲 蓬勃 发 展 ， 其 中 就 有 诸如 Jacquer- 
Droz 的 机 器 人 家 庭 ( 画 家、 音乐 家 和 作家 ) 和 kara- 
kuri- ningyo 机 械 木偶 〈 倒 茶 和 射箭 ) 这 样 的 发 明 。 

机 器 人 的 概念 得 以 清晰 地 建立 源 于 许多 极 具 创造 
力 的 历史 产物 。 但 是 ， 真 正 的 机 器 人 还 是 要 等 到 20 
世纪 其 基础 技术 发 展 后 才能 出 现 。1920 年 ， 英 文 单 
词 “ 机 器 人 ” (robot) 脱胎 于 斯 拉夫 语 中 意思 是 奴隶 
的 单词 “robota”， 它 第 一 次 被 捷克 剧 作 家 Karel 
Capek 用 在 其 剧目 “ 罗 院 姆 的 万 能 机 带 人 ” (Rossum’s 
Universal Robots) 中 。1940 年 ， 人 类 与 机 器 人 之 间 往 
来 的 道德 准则 就 被 认为 是 约束 在 众所周知 的 机 器 人 三 
原则 之 内 ， 这 个 机 器 人 三 原则 是 美 籍 俄 裔 科 约 小 说 家 


ERE - 阿 西 莫 夫 (Isaac Asimov) 在 他 的 小 说 


《Runaround》 中 提 到 的 。 

在 20 世纪 中 期 ， 人 们 进行 了 对 人 类 智能 与 机 器 
关联 的 第 一 次 探索 ， 这 标志 着 在 人 工 智能 领域 一 个 多 
产 时 代 的 来 临 。 在 这 一 时 期 ， 第 一 台 机 器 人 变 为 现 
实 ， 这 得 益 于 在 机 械 控制 、 计 算 机 和 电子 等 领域 的 科 


技 进 步 。 同 往常 一 样 ， 新 的 设计 会 推动 新 的 研究 和 发 
现 。 与 此 同时 ， 这 些 新 的 研究 和 发 现 又 促使 解决 问题 
方案 的 增加 ， 并 由 此 产生 新 的 概念 。 这 样 一 个 有 效 的 
循环 逐渐 交替 演变 就 催生 了 机 器 人 领域 的 知识 与 认 
知 一 一 更 准确 地 应 该 称 为 机 器 人 科学 与 技术 。 

早期 的 机 器 人 出 现在 20 世纪 60 年代， 它 的 产生 
主要 受到 两 方面 技术 的 影响 : 数控 机 器 在 精密 制造 业 
的 应 用 和 对 远程 放射 性 材料 的 遥控 操作 。 这 些 主 从 式 
机 械 辟 设计 出 来 用 于 重复 人 手臂 所 做 的 “点 到 点 ” 
的 机 械 运 动 ， 同 时 它们 具有 基本 的 控制 ， 并 对 环境 几 
平 没 有 感知 。 之 后 ， 在 20 世纪 中 后 期 ， 集 成 电路 、 
数字 计算 机 和 微型 元 器 件 的 发 展 使 计算 机 控制 机 器 人 
的 设计 和 编程 成 为 可 能 。20 世纪 70 年 代 ， 这 些 机 器 
人 ， 也 称 为 工业 机 器 人 ， 成 为 了 和 柔性 制造 系统 自动 控 
制 的 必要 组 成 。 它 们 不 只 在 汽车 工业 上 得 到 了 广泛 应 
用 ， 还 被 成 功 应 用 到 其 他 工业 生产 中 ， 例 如 金属 制造 
业 、 化 工业 、 电 子 业 和 食品 工业 中 。 最 近 ， 机 器 人 还 
在 工厂 之 外 找到 了 新 的 用 武之 地 ， 例 如 它们 在 清洁 、 
搜救 、 水 下 、 太 空 以 及 医疗 应 用 等 方面 均 具 有 广泛 的 
应 用 。 

20 世纪 80 年 代 ， 机 器 人 学 被 定义 为 研究 感知 与 
行动 之 间 知 能 连接 的 一 门 科 学 。 根 据 这 一 定义 ， 机 器 
人 通过 安装 移动 装置 (FF. Bes BB, 
pee) 来 实现 在 空间 中 的 移动 , 通过 操作 装置 
(BS. RPT. BA) 来 对 物体 进行 加 工 ， 其 
中 ， 一 些 合适 的 装置 赋予 了 机 器 人 具有 人 的 灵性 。 通 
过 分 析 由 传感器 得 来 的 机 髓 人 的 状态 参数 (位置 、 
速度 ) 以 及 与 周边 环境 相关 的 参量 ( 力 和 触觉 、 距 
离 和 视野 ) ， 机 器 人 就 具有 了 感觉 ;而 其 智能 连接 是 
通过 一 个 经 过 了 编程 、 规 划 和 控制 的 控制 架构 来 实现 
的 ， 这 种 结构 依赖 于 机 器 人 的 感觉 和 动作 模式 、 周 围 
环境 ， 以 及 自身 学 习 能 力 和 技能 习 得 过 程 。 

在 20 世纪 90 年 代 ， 人 类 诉 诸 机 器 人 的 各 种 需求 
推动 了 机 器 人 研究 的 发 展 。 这 些 需求 包括 在 危险 的 时 
候 解 决 人 类 的 安全 问题 (野外 机 器 人 ) ,或 提高 人 类 
的 操作 能 力 并 且 降 低 人 类 疲劳 程度 (人 类 机 能 增 
强 ) ,或 实现 一 些 人 在 充满 潜力 的 市 场 里 开发 产品 从 
而 改善 生活 质量 的 愿望 (服务 机 器 人 ) 。 这 些 应 用 场 
景 的 一 个 共同 之 处 就 是 它们 必须 运作 在 一 个 几乎 非 结 
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构 化 的 环境 中 ， 最 终 达 到 增加 能 力 和 获得 更 高 程度 自 
主权 的 要 求 。 

在 新 千年 来 临 之 际 ， 机 器 人 技术 在 范围 和 维度 上 
经 历 了 重大 变 单 。 这 种 扩张 使 机 器 人 领域 变 得 成 熟 ， 
也 使 其 相关 技术 获得 了 进步 。 机 器 人 技术 已 经 从 具有 
主导 优势 的 工业 热点 开始 迅速 扩展 到 成 为 人 类 世界 的 
挑战 〈 以 人 为 本 和 类 生命 机 器 人 ) 。 人 们 期 望 新 一 代 
的 机 需 人 可 以 与 人 安全 地 、 可 靠 地 在 家 庭 、 工 作 场 所 
共处 ， 在 社区 提供 服务 ， 在 娱乐 业 、 教 育 行业 、 医 疗 
保健 行业 、 制 造 业 等 方面 提供 支持 和 援助 。 

除去 实体 机 器 人 的 冲击 外 ， 智 能 机 器 人 的 发 展 揭 
示 了 在 不 同 研究 领域 和 学 科 内 可 以 开发 出 更 为 广泛 的 
应 用 ， 例 如 : 运动 生物 力学 、 触 觉 学 、 神 经 学 、 模 拟 
仿真 学 、 动 画 制作 、 外 科 手 术 和 传 感 网 络 学 科 等 。 作 
为 回报 ， 新 兴 领 域 的 挑战 证 明了 机 器 人 领域 具有 如 此 
多 样 化 的 增产 措施 和 启示 。 最 引 人 注 目的 进展 往往 就 
诞生 于 学 科 的 交叉 处 。 

WE, PRR Ar RKR E ODL AS A IA b E EE o 
究 ， 以 机 器 人 用 户 和 研发 者 为 主 的 群体 正在 形成 。 机 


杀人 社会 的 战略 目标 就 是 与 这 些 群 体 达成 拓展 与 科研 
合作 。 而 为 了 达到 这 个 目标 ， 在 未 来 所 要 进行 的 发 展 
与 可 以 预期 的 成 果 将 很 大 程度 上 依赖 于 科研 团体 的 
能 力 。 

在 过 去 几 十 年 中 ， 人 研究 结果 的 推广 、 文 献 期 刊 中 
记录 的 发 现 ， 以 及 学 术 会 议 上 的 讨论 对 机 器 人 的 发 展 
起 了 很 重要 的 作用 。 有 关机 器 人 的 科技 活动 已 经 引领 
了 专业 群体 的 成 立 ， 并 且 使 研究 网 络 开始 转向 这 个 领 
域 。 世 界 各 地 研究 机 构 在 机 器 人 学 方面 的 研究 生计 划 
的 介绍 ， 清 晰 地 展示 了 在 机 器 人 学 这 一 科学 领域 中 科 
研 已 经 能 够 达到 的 完善 程度 。 

机 器 人 学 的 密集 研究 情况 已 经 记录 在 了 具有 独特 
价值 的 参考 文献 中 ， 这 些 文献 旨 在 搜集 国际 机 器 人 科 
学 共同 体 的 意义 非凡 的 成 果 。 

《机 器 人 手册 》 一 书 从 学 科 基 础 说 起 ， 从 研究 领 
W, 直至 最 新 出 现 的 机 器 人 应 用 ， 展现 了 机 器 人 学 领 
域 的 一 幅 全 景 图 。 本 书 在 逻辑 上 材料 的 组 织 可 以 分 为 
三 个 层次 ， 它 们 分 别 反 映 了 机 器 人 领域 的 历史 发 展 ， 
如 图 1 所 示 。 





图 1 本 手册 的 结构 


第 一 层 (第 1 篇， 包含 9 章 ) : 机 器 人 科学 基础 ， 
包括 机 器 人 的 力学 、 感 觉 、 设 计 和 控制 。 第 二 层 包 
括 : 统一 的 方法 论 和 机 器 人 构造 技术 (第 2 篇， 包含 
9 章 ) ， 感觉 和 认 知 (第 3 篇 ,， 包含 7 章 ) ， 操 作 与 接 
O (第 4 篇 ， 包 含 8 章 ) ， 移 动 式 和 分 布 式 机 器 人 
(第 5 篇 ,包含 8 章 )。 第 三 层 则 致力 于 更 先进 的 应 
用 ， 比 如 在 战争 和 服务 领域 的 机 器 人 【第 6 篇 ， 包含 
14 章 ) 以 及 以 人 为 中 心 和 类 生命 机 器 人 (第 7 篇 ， 
包含 9 章 )。 


第 1 篇 介绍 了 在 模型 、 设 计 和 控制 机 器 人 系统 中 
用 到 的 基本 原则 和 方法 。 包 括 运动 学 、 动 力学 、 力 学 
设计 和 驱动 、 感 党 和 评价 、 运 动 规划 、 运 动 控制 、 力 
控制 、 机 器 人 体系 结构 与 程序 设计 、 用 于 任务 规划 和 
学 习 的 机 器 人 智能 推理 方法 。 本 篇 每 一 章 分 别 阐述 了 
上 述 的 某 个 主题 。 在 后 续 部 分 中 ， 这 些 主题 将 被 拓展 
和 应 用 到 特殊 的 机 器 人 结构 和 系统 中 。 

第 2 篇 涉及 机 器 人 在 实际 物理 实现 过 程 中 的 设 
计 、 模 型 、 运 动 计 划 和 控制 等 问题 。 包 括 一 些 更 加 明 


显 的 机 器 人 结构 ， 如 臂 、 腿 、 手 ， 轮 式 移动 机 器 人 和 
平台 ， 以 及 一 些 在 毫米 、 纳 米 量 级 的 机 器 人 结构 。 其 
中 一 些 章 节 曾 述 了 评价 指标 和 模型 辨识 ， 并 成 功 分 析 
了 串联 元 余 度 机 构 、 并 联机 构 、 柔 性 机 器 人 、 机 器 
于 、 机 器 腿 ， 轮 式 机 器 人 以 及 微米 和 纳米 尺度 机 
ATA o 

第 3 篇 涵盖 了 机 器 人 的 不 同感 觉 形态 和 跨 时 空 传 
感 数据 整合 。 这 将 用 于 生成 机 器 人 模型 及 外 部 环境 。 
机 葵 人 学 是 感知 和 行动 的 智能 耦合 。 第 3 篇 内 容 是 对 
第 2 篇 的 补充 ， 着 重 于 继续 建立 一 个 系统 。 本 篇 包括 
接触 感知 、 本 体感 知 和 外 体感 知 ， 同 时 展示 了 主要 的 
传感器 类 型 ， 如 触觉 、 视 觉 里 程 计 、 全 球 定位 系统 、 
测 距 和 视觉 。 还 包含 了 基本 的 传感器 模型 和 多 传感器 
信息 融合 。 其 中 关于 感觉 融合 的 章节 介绍 了 跨 时 空 感 
觉 信息 集成 所 需 的 数学 工具 。 

第 4 篇 介绍 了 机 器 人 与 物体 之 间 ， 机 器 人 与 人 之 
间 ， 机 响 人 之 间 的 交互 。 操 作 能 通过 辟 或 手指 的 直接 
接触 或 仅仅 是 推动 来 处 理 一 个 物体 。 接 口 能 使 人 机 交 
互 变 得 直接 或 间接 。 为 了 提高 机 器 人 操作 的 灵巧 度 ， 
本 篇 的 前 半 部 分 介绍 了 诸如 操作 任务 的 动作 、 接 触 模 
拟 和 操作 、 抓 取 、 协 同 操作 等 问题 。 为 实现 更 熟练 的 
操作 或 更 强大 的 人 /机 系统 ， 后 半 部 分 讨论 了 触觉 理 
论 、 遥 操作 机 器 人 、 网 络 遥控 机 器 人 和 让 人 类 机 能 增 
强 的 外 骨骼 系统 。 

第 5 篇 涵盖 了 各 种 问题 。 本 篇 介绍 了 轮 式 机 器 人 
运动 规划 和 控制 ， 同 时 考虑 了 运动 约束 条 件 、 认 知 和 
世界 模型 、 同 步 定 位 与 建 图 、 控 制 架 构 方 面 的 集成 等 
的 影响 。 移 动机 器 人 确实 是 复杂 集成 系统 的 典范 。 本 
篇 在 移动 机 器 人 背景 下 补充 了 第 1 篇 的 基础 原理 ， 给 
出 了 感知 的 角色 地 位 ， 在 传 感 方面 与 第 3 篇 紧密 联 
系 。 态 外 ， 还 讨论 了 多 机 器 人 交互 和 系统 、 模 块 化 、 
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可 重 构 机 器 人 ， 也 介绍 了 网 络 机 器 人 。 

第 6 篇 介绍 野外 机 器 人 和 可 在 所 有 环境 中 工作 的 
应 用 型 服务 机 器 人 。 包 括 工业 机 器 人 ， 各 种 各 样 的 在 
海 、 陆 、 空 、 航 天 领域 应 用 的 机 器 人 ， 直 至 教学 机 器 
人 。 本 篇 以 第 1 篇 ~ 第 5 篇 的 内 容 为 基础 ， 描 述 了 如 
何 令 机 器 人 工作 。 

第 7 篇 介绍 了 如 何 创 建 在 以 人 为 中 心 的 环境 中 工 
作 的 机 器 人 ， 包 括 仿 人 (或 称 为 拟人 ) 或 者 仿 其 他 
生物 外 观 的 机 器 人 的 设计 、 传 感 、 传 动 、 驱 动 与 控制 
结构 ， 演 示 编 程 和 安全 性 编程 的 用 户 界 面 内 容 ， 机 器 
人 的 社会 伦理 性 启示 。 

本 手册 不 仅 为 机 器 人 专家 而 写 ， 也 为 将 机 器 人 作 
为 扩展 领域 的 初学 者 〈 工 程 师 、 医 师 、 计 算 机 科学 
家 和 设计 师 ) 提供 了 宝贵 的 资源 。 尤 其 要 强调 的 是 ， 
第 1 篇 的 指导 价值 对 于 研究 生 和 博士 后 很 重要 ,第 2 
篇 ~ 第 5 篇 对 于 机 器 人 领域 所 覆盖 的 研究 有 着 很 重要 
的 科研 价值 ， 第 6 篇 和 第 7 篇 对 于 对 新 应 用 感 兴趣 的 
工程 师 和 科学 家 有 着 很 大 的 附加 价值 。 

本 书 各 章 的 内 容 均 经 过 仔细 期 酌 ， 待 验证 的 方法 
和 尚未 完全 成 立 的 方法 均 未 列 人 。 本 手册 从 客观 的 角 
度 出 发 ,包含 多 种 方法 ， 具 有 高 的 收藏 价值 。 每 章 都 
有 一 个 简短 的 摘要 ， 并 且 在 概述 部 分 介绍 了 相关 领域 
的 扩 术 发 展 水 平 。 主 体 部 分 是 以 一 种 教学 方式 来 阐述 
的 。 尽 可 能 避免 元 长 的 数学 推导 ， 方 程 、 表 格 和 算法 
均 以 便于 使 用 的 形式 给 出 。 最 后 一 节 给 出 了 结论 和 题 
目 ， 以 供 进一步 阅读 。 

从 机 器 人 的 基础 开始 到 最 后 讲述 机 器 人 的 社会 意 
义 和 伦 理 启 示 ， 本 书 的 64 章 全 面 收集 了 机 器 人 领域 
在 50 年 之 中 的 进展 。 这 是 对 机 器 人 领域 取得 成 就 的 
一 种 证 明 ， 也 是 将 来 新 的 前 沿 机 器 人 取得 更 大 进展 的 
保证 。 
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第 1 篇 机 器 人 基础 介绍 了 用 于 开发 机 器 人 系统 的 
基本 原理 和 方法 。 为 了 完成 关于 机 器 人 理论 的 任务 ， 
已 经 攻破 了 许多 运动 学 、 动 力学 、 设 计 、 驱 动 、 传 
感 、 运 动 规划 、 控 制 、 程 序 设计 和 任务 规划 中 的 挑战 
性 难题 。 本 篇 章节 盖 述 了 上 述 领域 里 的 最 基本 的 问 
题 。 其 中 关于 机 器 人 的 一 些 基 本 问题 概述 如 下 。 通 
稼 ， 机 器 人 有 多 个 自由 度 ， 所 以 它 可 以 完成 一 系列 必 
需 的 三 维 运动 。 为 了 完成 一 项 任务 ， 关 节 驱 动 器 的 运 
动 和 转 矩 、 要 求 的 运动 和 力 的 运动 学 和 动力 学 关系 会 
非常 复杂 。 为 了 完成 要 求 的 动作 ， 连 杆 、 关 节 结 构 、 
驱动 的 设计 也 是 一 项 挑战 。 机 器 人 是 非 线性 看 合 系 
统 ， 其 动力 学 非常 复杂 ， 因 此 难于 控制 。 当 环境 变 得 
不 确定 时 ， 控 制 机 器 人 将 会 变 得 更 加 复杂 ， 所 以 也 就 
需要 精确 的 传 感 和 估计 技术 。 

除了 控制 运动 ， 当 操控 物体 或 者 与 人 交互 时 ， 就 
需要 控制 机 器 人 和 环境 间 的 相互 作用 力 。 一 项 基本 的 


机 器 人 学 任务 就 是 让 复杂 物体 ， 在 充满 了 障碍 物 的 场 


地 ， 从 出 发 点 运动 到 目的 地 而 不 与 任何 障碍 物 发 生 碰 
撞 ， 这 是 一 个 非常 坏 手 的 计算 难题 。 为 了 达到 人 类 的 
智能 ， 机 器 人 需要 装备 一 些 精密 的 任务 规划 控制 器 ， 
这 种 装置 可 以 部 分 感知 环境 ， 在 动力 学 方面 拥有 一 些 
象征 性 的 分 析 判 断 能 力 。 机 器 人 的 软件 构架 因为 这 些 
需求 也 相应 地 会 有 一 些 特殊 要 求 。 

本 篇 将 详细 阐述 ， 以 上 段落 概要 介绍 的 基本 问 
题 ， 但 是 更 加 深入 的 了 解 需要 参照 其 他 相关 手册 。 本 
篇 介绍 的 运动 学 、 动 力学 、 机 械 设计 、 控 制 原理 可 以 
应 用 到 机 器 人 的 结构 中 ,这些 结构 包括 臂 、 手 和 腿 
(第 2 篇 )， 也 可 以 应 用 到 机 械 辟 (第 4 篇 )、 轮 式 机 
arA (535 篇 )、 服 务 机 器 人 (第 6 篇 )。 力 的 控制 
对 于 操控 器 和 它 的 接口 (第 4 篇 ) 来 说 尤为 重要 。 
这 里 阐述 的 基本 传 感 和 估计 技术 已 经 充分 发 展 ， 而 且 
已 经 应 用 到 特殊 的 传 感 系统 中 ， 这 将 会 在 第 3 篇 进行 
介绍 。 运 动 规划 在 操控 器 〈 第 4 篇 ) 和 移动 式 与 分 
布 式 机 器 人 系统 〈 第 5 篇 ) 中 是 一 个 很 重要 的 方面 。 

机 何人 的 系统 构架 和 人 工 管 能 的 推理 理论 在 运动 
学 、 机 械 动 力 设 计 、 控 制 原理 和 分 布 式 机 器 人 学 
(第 5 篇 ) 、 以 人 为 中 心 和 仿生 机 器 人 学 (第 7 篇 ) 
中 起 到 特别 重要 的 作用 。 

了 解 第 1 篇 的 概述 后 ， 我 们 下 面 提供 关于 每 章 的 
简要 概述 。 

第 1 章 运动 学 ， 提 供 大 量 的 表示 法 和 惯例 来 描述 
在 机 避 人 装置 中 物体 的 运动 。 其 中 包括 旋转 矩阵 、 欧 
拉 角 、 四 元 法 、 齐 次 变换 、 旋 转变 换 、 和 矩阵 指数 参数 
化 、 普 吕 克 坐标 系 。 提 供 了 所 有 普通 的 关节 类 型 的 运 
动 学 表示 方法 ， 同 时 也 提供 修正 形式 的 D-H 参数 法 。 





这 些 坐 标 表示 法 会 被 应 用 到 计算 工作 空间 、 正 运动 学 
或 者 逆 运 动 学 、 正 瞬 时 运动 学 和 首肯 时 运动 学 、 雅 可 
比 行列 式 和 静态 扭转 传动 中 。 

第 2 章 动力 学 ,介绍 动力 学 方程 ， 从 而 可 以 得 出 
张 动 和 作用 在 机 器 人 上 接触 力 的 关系 ， 以 及 力 所 导 致 
的 加 速度 运动 轨迹 。 提 供 了 有 效 的 算法 ， 以 此 来 计算 
重要 的 运动 学 问题 ， 包 括 道 动力 学 、 正 动力 学 、 关 节 
空间 惯性 矩阵 和 操作 空间 惯性 矩阵 。 这 种 算法 可 能 会 
锌 应 用 到 固定 基 座 机 器 人 、 移 动机 器 人 、 并 联机 器 人 
中 。 这 种 简洁 的 表达 式 算法 是 由 于 需要 用 六 维 空间 运 
动 来 描述 刚体 的 速度 、 加 速度 、 惯 性 等 。 

第 3 章 机 构 与 驱动 ， 聚 焦 于 机 器 人 系统 的 设计 和 
构建 的 指导 原则 。 用 运动 学 方程 和 雅 可 比 行列 式 来 描 
述 工作 空间 和 机 械 性 能 优点 ， 并 以 此 来 指导 机 器 人 尺 
十 和 关节 布置 。 串 联机 器 人 或 相似 类 型 的 机 器 人 都 可 
以 处 理 。 设 计 关 节 结 构 和 选择 驱动 器 、 传 动机 构 要 考 
虑 到 实际 情况 。 还 介绍 了 速度 、 加 速度 、 可 重复 性 及 
其 他 措施 方面 的 机 器 人 性 能 。 

第 4 章 传 感 与 估计 ， 简 要 介绍 了 在 机 器 人 学 中 具 
有 广泛 适用 性 的 传 感 理论 与 估计 技术 。 这 些 理论 和 技 
术 提 供 有 关 环 境 和 机 器 人 系统 状态 的 信息 。 主 要 按照 
传 感 、 特 征 提取 、 数 据 融 合 、 参 数 估计 和 模型 集成 等 
来 介绍 。 介 绍 和 描述 了 多 种 常规 传 感 形式 。 在 线性 和 
非 线性 理论 系统 中 讨论 了 估计 理论 ， 包 括 统计 估计 、 
卡尔 曼 滤 波 器 和 基于 采样 的 理论 。 也 介绍 了 一 些 常用 
的 估计 表示 法 。 

第 5 章 运 动 规划 ， 在 充满 了 障碍 物 的 地 方 ， 对 于 
复杂 的 机 体 ， 完 成 从 出 发 点 到 目的 地 的 过 程 中 不 碰撞 
任何 物体 是 机 器 人 的 基本 任务 。 介 绍 基本 的 路 线 设计 
难题 ( 钢 雁 搬运 者 难题 )， 这 一 章 仅 集 中 于 基于 样品 
的 规划 理论 ， 因 为 它 具 有 非常 广泛 的 适用 性 。 根 据 各 
种 不 同 的 限制 条 件 进 行规 划 是 一 种 续 密 的 行为 ， 而 且 
对 于 轮 式 移动 机 器 人 也 是 非常 重要 的 。 相 对 于 基本 的 
运动 规划 而 言 ， 扩 展 的 、 变 化 的 ， 也 可 以 说 更 加 高 级 
的 问题 将 会 在 章节 的 末尾 讨论 。 

第 6 章 运动 控制 ,集中 于 精确 的 机 器 人 操作 器 的 
运动 控制 。 面 临 的 主要 挑战 是 非 线 性 夺 合 动力 学 和 组 
织 的 或 非 组 织 的 不 确定 因素 。 这 一 章 讨论 的 主题 用 于 
PRR ARABI lle, HLTA The es Fe hl A PID 
(比例 -积分 -微分 ) 控制 到 计算 转 托 控制。 适应 性 和 
强健 控制 用 于 处 理 系统 不 确定 性 问题 。 这 章 最 后 以 可 
重复 性 运动 的 数字 化 实现 和 认 知 控制 的 一 些 实际 思考 
作为 结束 。 

第 7 章 力 控制 , 集中 于 机 器 人 系统 和 它 的 外 在 环 
境 的 相互 作用 力 的 控制 。 这 一 章 将 相互 作用 力 的 控制 
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分 成 两 类 ， 间接 和 直接 的 力 的 控制 。 它 们 的 区 别 在 于 
完成 力 的 控制 不 带 有 (间接 ) 或 带 有 直接) 明确 
终止 力 的 反馈 环 上 路。 阻抗 控制 和 混合 力 或 者 运动 控制 
分 别 是 这 两 种 控制 类 型 的 代表 。 相 互 作用 任务 的 基本 
问题 的 模型 被 表达 出 来 ， 它 为 力 控制 策略 莫 定 基础 。 

第 8 章 机 器 人 体系 结构 与 程序 设计 ， 介 绍 软 件 架 
构 和 用 于 发 展 机 器 人 系统 的 辅助 性 程序 设计 工具 和 环 
境 。 机 帮 人 架构 有 特殊 的 要 求 ， 这 是 不 确定 、 动 态 的 
环境 和 机 器 人 相互 作用 的 必然 要 求 。 这 一 章 讨 论 分 层 
机 顺 人 控制 构 扣 一 一 行为 控制 、 执 行 领导 和 任务 计划 


者 一 一 组 件 的 主要 类 型 和 相互 连接 这 些 组 件 的 常用 
技术 。 

第 9 章 机 器 人 智能 推理 方法 ， 描 述 了 目前 在 基于 
符号 的 推理 理论 和 应 用 方面 的 人 工 智能 的 工艺 水 平 ， 
这 方面 的 人 工 智 能 被 认为 是 和 机 器 人 学 最 为 相关 的 。 
因为 动态 的 和 部 分 未 知 的 工作 环境 ， 所 以 在 移动 机 器 
人 上 推理 被 认为 是 极 具 挑战 性 的 。 这 一 章 描述 了 知识 
表达 和 推 新 ， 履 盖 了 逻辑 学 和 概率 论 的 方法 。 除 了 推 
理 理论 ， 这 一 章 还 考虑 了 遗传 推理 应 用 ， 即 动作 规划 
与 机 器 人 学 习 。 
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1.1 概述 


BRIEF AULA, APM, BLA ADL ete AWE 
接 的 刚体 所 构成 的 系统 。 刚 体 在 空间 的 位 置 和 姿态 统 
称 为 位 姿 。 因 此 ， 机 器 人 运动 学 描述 的 是 位 姿 、 速 
度 、 加 速度 ， 以 及 构成 机 构 的 物体 位 姿 的 高 阶 导数 。 
由 于 运动 学 不 涉及 引起 运动 的 力 / 力 矩 ， 本章 重 点 讨 
论 位 秦 和 速度 。 这 些 介绍 是 动力 学 (第 2 章 )、 运 动 
规划 (第 5 章 ) 、 运 动 控制 (第 6 章 ) 算法 的 基础 。 

在 物体 连接 的 众多 可 能 拓扑 中 ， 有 两 种 拓扑 在 机 
器 人 中 特别 重要 ， 分 别 是 串联 链 式 机 构 和 全 并 联机 
构 。 若 刚体 系统 中 的 每 一 个 中 间 刚 体 均 与 其 他 两 个 刚 
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体 连 接 ， 第 一 个 和 最 后 一 个 刚体 只 与 一 个 刚体 连接 ， 
则 该 刚体 系统 为 串联 链 式 机 构 。 若 刚体 系统 中 的 两 个 
刚体 通过 多 个 关节 连接 ， 则 该 刚体 系统 为 全 并 联机 
构 。 实 际 上 ， 每 一 个 关节 本 身 就 是 一 个 串联 链 。 本 章 
主要 着 眼 于 用 于 串联 链 的 算法 ， 并 联机 构 将 在 第 12 
章 详细 讨论 。 


1.2 ”位置 与 姿态 表示 


在 空间 上 ， 刚 体 运 动 学 可 以 看 做 是 物体 位 姿 不 同 
表示 方法 的 对 比 研究 。 平 移 和 旋转 ， 两 者 结合 称 为 刚 
体 的 偏 移 ， ed 没有 哪 一 种 方 
法 对 所 有 的 问题 都 是 最 优 的 ， 每 一 种 方法 对 解决 不 同 


的 问题 各 有 优势 。 

在 欧 几 里 德 空间 中 ， 对 一 个 物体 定位 的 最 少 坐标 
数量 为 6。 许 多 空间 位 姿 表 示 法 采用 上 界 坐 标 集 ， 其 
中 的 坐标 之 间 存 在 辅助 关系 。 独 立 的 辅助 关系 数量 为 
6， 它 不 同 于 坐标 数量 。 

本 章 及 后 续 章 节 频 繁 使 用 参考 坐标 系 或 简称 坐标 
系 。 一 个 参考 坐标 系 i 由 坐标 原点 和 3 个 相互 正 交 的 
基 矢 量 构 成 ， 固 定 于 特定 的 物体 上 。 坐 标 原 点 记 为 
0;， 基 矢量 记 为 x， 和 五)。 一 个 物体 的 位 姿 总 是 
相对 于 其 他 的 物体 进行 表达 ， 故 它 可 以 表示 为 一 个 坐 
标 系 相对 于 另 一 个 坐标 系 的 位 姿 。 类 似 地 ， 一 个 刚体 
的 偏 移 可 以 表示 为 两 个 坐标 系 之 间 的 偏 移 ， 其 中 一 个 
刚体 可 以 看 做 是 运动 的 ， 另 一 个 刚体 看 做 是 固定 的 。 
这 表示 观测 者 位 于 固定 坐标 系 下 的 固定 位 置 ， 并 不 存 
在 任何 绝对 固定 的 坐标 系 。 


1.2.1 位 置 与 平移 


坐标 系 i 的 原点 相对 于 坐标 系 j 的 位 置 可 以 表示 
为 3 x1 的 矢量 


该 矢量 中 的 元 素 是 0; 在 坐标 系 了 中 的 笛 卡 儿 坐 标 ， 
ERE’ p, 在 相应 坐标 轴 上 的 投影 。 该 矢量 中 的 元 
素 也 可 以 表示 为 O, 在 坐标 系 j 中 的 球面 或 柱 面 坐 
标 ， 以 有 利于 分 析 具 有 球 关节 或 柱 关 节 的 机 器 人 
机 构 。 

平移 是 指 这 样 的 偏 移 ， 刚 体 上 的 任何 一 点 不 再 处 
于 其 初始 位 置 ， 刚 体 上 的 所 有 直线 平行 于 其 初始 方向 
(点 和 直线 不 是 必须 包含 在 某 刚体 的 边界 上 ， 然 而 ， 
空间 中 的 任何 点 和 直线 都 可 以 被 认为 严格 固定 在 物体 
上 )。 一 个 物体 在 空间 的 平移 ， 可 以 表示 为 平移 前 后 
的 位 置 。 相 反 ， 一 个 物体 的 位 置 可 以 表示 为 平移 ， 即 
从 一 个 固定 于 物体 的 坐标 系 与 固定 坐标 系 一 致 的 位 
置 ， 移 动 到 当前 的 固定 于 物体 的 坐标 系 与 固定 坐标 系 
不 一 致 的 位 置 。 因 此 ， 任 何 位 置 的 表示 方法 均 可 用 于 
表示 平移 ， 反 之 亦 然 。 


姿态 与 旋转 


与 位 置 相 比 ， 姿 态 的 表示 方法 更 加 丰富 。 本 节 并 
不 罗列 所 有 的 姿态 表示 方法 ， 仅 给 出 机 器 人 中 最 常用 
的 姿态 表示 方法 。 

旋转 是 指 这 样 的 偏 移 ， 刚 体 上 至 少 有 一 点 处 于 其 
初始 位 置 ， 不 是 刚体 上 的 所 有 直线 平行 于 其 初始 方 
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向 。 例如， 一 个 物体 在 圆 轨道 上 绕 一 个 过 圆心 的 轴 旋 
转 ， 在 旋转 轴 上 的 任 一 点 是 物体 上 保持 初始 位 置 的 
点 。 与 表示 位 置 的 平移 一 样 ， 任 何 表示 姿态 的 方法 均 
可 表示 旋转 ， 反 之 亦 然 。 

1. 旋转 矩阵 

坐标 系 i 相对 于 坐标 系 j 的 姿态 可 以 利用 基 矢 量 
(x, ¥; 2) TERRE (x, y %) 中 形成 的 矢量 表 
示 。 形 成 的 矢量 记 为 Cx, J 12), WMS x3 Hi 
阵 ， 称 为 旋转 矩阵 。’R, 中 的 元 素 是 两 个 坐标 系 基 矢 
量 的 点 积 。 


> > 


(1.1) 


> 


i° 4; Ntg ZZ 
因为 基 矢 量 是 单位 矢量 ， 而 且 任 何 两 个 单位 矢量 的 点 
积 是 其 夹 角 的 余弦 ， 所 以 上 述 元 素 被 称 为 方向 余弦 。 

一 个 基本 旋转 是 坐标 系 i 绕 z 轴 旋转 角度 8 形成 


HJIR EF 
cos@ -sin 0 
R,(6) | cosd | (1.2) 


0 0 1 
绕 轴 旋转 角度 9 形成 的 矩阵 


cosð 0 sing 
wo-| 0 1 0 | (1.3) 


-sm 0 cos@ 


ie 3 ah ete fe 0 形成 的 矩阵 


1 0 0 
so- cos6 -aa (1.4) 


O sinf cos@ 


旋转 矩阵 R, 含有 9 个 元 素 ， 其 中 只 有 3 个 参数 
是 定义 物体 在 空间 的 姿态 所 需要 的 。 因 此 ， 旋 转 矩 
阵 的 元 素 中 具有 6 个 辅助 关系 。 因 为 坐标 系 i 的 基 
矢量 是 相互 正 交 的 ， 坐 标 系 j 的 基 矢 量 也 是 相互 正 
交 的 ， 所 以 由 这 些 正 交 矢量 的 点 积 形成 的 'R, 的 列 矢 
量 也 是 正 交 的 。 由 正 交 矢量 构成 的 矩阵 称 为 正 交 和 拢 
阵 ， 它 具有 一 个 特性 ， 即 其 道 矩阵 是 其 转 置 矩阵 。 
该 特性 决定 了 其 6 个 辅助 关系 ， 其 中 3 个 关系 为 列 
矢量 具有 单位 长 度 ， 另 外 3 个 关系 为 列 矢量 相 互 正 
交 。 另 外 ， 旋 转 和 矩阵 的 正 交 性 对 于 道 序 坐 标 系 依然 成 
立 。 坐 标 系 7 相对 于 坐标 系 i 的 姿态 为 旋转 矩阵 RR， 
显然 ,'R; 的 行 矢量 即 为 R, 的 列 矢量 。 旋 转 和 矩阵 通过 
简单 的 矩阵 相 乘 相 结合 ， 可 以 获得 坐标 系 守 相对 于 坐 
标 系 上 的 姿态 
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'R, ='R, JR, 

总 之 , R, 是 一 个 将 坐标 系 i 中 表示 的 矢量 转换 为 
坐标 系 j 中 表示 的 矢量 的 旋转 矩阵 ， 它 提供 坐标 系 ; 
相对 于 坐标 系 j 的 姿态 表示 ， 也 可 表示 为 坐标 系 i 到 
坐标 系 j 的 旋转 。 表 1. 1 列 出 了 本 节 中 其 他 姿态 表示 
的 等 价 变换 矩阵 ， 表 1. 2 给 出 了 从 旋转 矩阵 到 其 他 姿 
态 表示 的 转换 。 


表 1.1 其 他 姿态 表示 的 等 价 变换 矩阵 ， 


缩写 ce = ecosg，se =sing, v, =1 -ceosp 


Z-Y-X 欧 拉 角 (a, B, y): 
Cacg CadpSy 一 SaCy Cy Spl, + sas,y 
iR, =| Sag Sasgsy + cacy saspcy — Cacy 


— sg Cpsy Cal, 





X-Y-2 固定 角 (CW, 6, o): 


| IRL = Solo SaSpSy 十 ChCcy Sosocy — Cgc, 


Sg cosy Cecy 





A 
角 - 轴 Ow : 
İR, =| w wv, +w-s wiv, +e WW Vy — WS 
iT syp z"0 pd | 8 yep x°@ 


2 





单位 四 元 数 (Ep, Els E29 £3)": 


1 -2( 23 +63) 2( E152 — 20863) 2( £83 + £9€>) 
IR, = 2( EE + Egga) 1 -2(8 +63) 2( 283 ~ pe, ) 
2( gle3 -£062 ) 2(€363 + €£,) 


1 -2( 67 +23) 





1.2 从 旋转 矩阵 到 其 他 姿态 表示 的 转换 


nl Tz Ts 
.731 7T32 733 
Z-Y-X BALA (a, B, y): 


B= Atan2( - ml ， VTi +721) 


721 ri 
=A —, — 
a tan2( cosg’ =) 


732 733 
= Atan21 一 一 - —— 
y (> oes) 


( 续 ) 





X-¥-2 AER (Ww, 0, 中): 
0 = Atan2( -六 1 ， WwW rm +73) 


cos cos@ 


y= Atan2( 132 2) 
cos@’ cos 





角 - 轴 Ow: 
90= arceos( ru 十 ro 十 43 1) 
2 


T32 — 723 
A 1 
w= | My — 73 
2sing 
Fai Tz 


CC 
单位 四 元 数 (£0, £1, E2, £3)": 


1 
Eo =a Jl Fry 十 722 +73, 


_ 132 一 723 


E 
1 4eo 


_713 7731 


E 
2 4&5 


_721 Ti? 


E 
3 4£5 





2. Ra 

作为 一 个 最 小 表示 ， 坐 标 系 i 相对 于 坐标 系 j 的 
姿态 可 表示 为 3 个 角 (a, B, y) 的 一 个 矢量 。 这 
些 角 被 称 为 欧 拉 角 ， 每 个 角 代表 绕 一 个 轴 的 旋转 。 
在 这 种 方式 下 ， 每 个 轴 的 相继 旋转 取决 于 以 前 的 旋 
转 ， 旋 转 的 顺序 需 与 定义 姿态 的 3 个 角 的 顺序 -一 致 。 
例如 ， 本 手册 使 用 符号 (a, B, y) 表示 Z-Y-X Ek 
拉 角 ， 其 含义 如 下 : 在 初始 状态 下 运动 坐标 系 i 与 
固定 坐标 系 7 重合 ，a 是 坐标 系 守 的 2 轴 的 旋转 ，B 
是 坐标 系 i 的 7》 轴 的 旋转 ，y 是 坐标 系 i 的 * 轴 的 旋 
转 。 其 等 价 变 换 和 矩阵:R, 见 表 1.1。2Z-Y-Z 和 Z-X-Z 
欧 拉 角 是 12 种 其 他 顺序 旋转 中 的 另外 两 种 常用 的 表 
示 方 式 。 

无 论 旋转 顺序 如 何 ， 当 第 一 次 和 最 后 一 次 旋转 在 
同一 个 轴 上 时 ， 欧 拉 角 姿态 表示 会 存在 奇异 问题 。 由 
表 1.2 可 知 ， 当 B= + 上 90* 时 ， 角 a My 难以 区 分 〈 对 
F Z-Y-Z A Z-X-Z 欧 拉 角 ， 当 第 2 次 旋转 为 0° 或 
180* 时 ， 同 样 存在 奇异 问题 )。 这 就 出 现 了 一 个 与 角 
速度 矢量 ( 即 欧 拉 角 对 时 间 的 导数 ) 相关 的 问题 ， 
它 会 在 某 种 程度 上 限制 欧 拉 角 在 机 器 人 系统 建 模 上 的 
应 用 。Z- 六 三 欧 拉 角 的 角速度 关系 为 


a 一 sing 0 1 Ww, 
B =| cosGsiny cosy O0 || œ, (1.5) 
cosßcosy -sinß 0 


3. HER 

坐标 系 i 相 对 于 坐标 系 j 的 姿态 也 可 表示 为 为 外 
3 个 角 的 一 个 矢量 ,其 中 每 个 角 代 表 绕 固定 坐标 系 一 
个 轴 的 旋转 。 相 应 地 ， 这 些 角 被 称 为 固定 角 ， 旋 转 的 
顺序 需 与 重新 定义 姿态 的 3 个 角 的 顺序 一 致 。 其 中 ， 
定义 为 (Y, 6, 中 ) 的 X-Y-2Z 固定 角 ， 是 在 12 种 可 
能 的 旋转 顺序 中 常用 的 一 种 。 运 动 坐 标 系 i 与 固定 坐 
标 系 j 在 初始 状态 下 重合 ,yw RAE % 的 旋转 ， 
称 为 偏转 ; 9 FE SEA FE RH y, HE, PRA 
p BB ER, KARR. 

其 旋转 的 顺序 根据 这 些 角 定 义 。 每 个 角 代 表 绕 
一 个 轴 的 旋转 。 比 较 表 1.1 中 的 相应 等 价 旋转 变换 
和 表 1.2 中 的 相应 转换 ， 可 以 发 现 ，X-Y-2Z 固定 角 
5 Z-Y-X ORAS OH, MHa=6, B=6, y= 
炎 。 上 述 结果 表明 ， 绕 固定 坐标 系 的 3 个 轴 旋 转 定义 
的 姿态 ， 与 以 相反 顺序 绕 运 动 坐标 系 的 3 个 轴 旋 转 定 
义 的 姿态 相同 。 同 样 ， 所 有 方式 的 固定 角 表 示 的 姿态 
也 像 欧 拉 角 表示 的 姿态 那样 ， 具 有 奇异 问题 。 固 证 角 
对 时 间 的 导数 与 角速度 矢量 之 间 的 关系 ， 也 类 似 于 欧 
拉 角 对 时 间 的 导数 与 角速度 矢量 之 间 的 关系 。 

4. 角 - 轴 

一 个 角度 9 与 一 个 单位 矢量 w 相 结 合 ， 也 可 以 表 
示 坐 标 系 i 相对 于 坐标 系 j 的 姿态 。 在 这 种 情况 下 ， 
坐标 系 i 绕 相对 于 坐标 系 j 定 义 的 矢量 w=(w。 w, 
w "旋转 角度 6。 矢量 入 为 有 限 旋转 的 等 价 轴 。 角 - 
轴 表 示 方 式 常 记 作 0w (Ow, Ow, 9w,) 。 角 - 轴 
表示 方式 因 采 用 4 个 参数 ， 故 具有 一 个 元 余 参 数 。 
辅助 关系 是 矢量 w 为 单位 矢量 ， 即 其 模 长 为 1。 即 
使 存在 该 辅助 关系 ， 角 - 轴 表 示 方 式 也 不 是 唯一 的 ， 
这 是 因为 绕 矢 量 -旋转 -9 与 绕 矢 量 w 旋转 6 是 等 
价 的 。 表 1.3 给 出 了 角 - 轴 表示 与 单位 四 元 数 的 姿态 
表示 之 间 的 转换 。 这 两 种 表示 与 欧 拉 角 或 固定 角 之 
间 的 转换 见 表 1.2， 与 等 价 旋 转 矩 阵 之 间 的 转换 见 
表 1.1。 利 用 密切 相关 的 四 元 数 表示 ， 更 容易 处 理 
速度 关系 。 

5. 四 元 数 

四 元 数 表示 姿态 起 源 于 Hamilton", 2m H 
Gibbs!!! 和 Grassmann!'*! 改进 为 更 简化 的 矢量 ， 它 
对 于 解决 机 器 人 学 中 的 矢量 /和 矩阵 表示 的 奇异 问题 非 
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常 有 用 … 。 四 元 数 不 像 欧 拉 角 那样 具有 奇异 问题 。 


R13 角 - 轴 表示 与 单位 四 元 数 的 
姿态 表示 之 间 的 转换 

角 - 轴 9w 到 单位 四 元 数 (£9, Els 22， £3): 

8 

£9 = COS -5 
£1 = w,sin -2 
a 8 
En = Wy sin ~~ 
. 8 
E3 =w, sn -y 

单位 四 元 数 (£05 Els £2， e)" 到 角 - 轴 pw: 


0 =2arccoseo 














四 元 数 定义 为 如 下 形式 : 

E =£ tE ite +ek 
AH, ER s En en & 是 比例 因子 ， 有 时 也 称 
为 欧 拉 参数 ，i、j、 上 是 算 子 。 这 些 算 子 的 定义 符合 
如 下 规则 ， 

ü=ğj=kk= -1, y=k, jk=i, 
ki=j, ji=—k, j= -i, ik= -j 
两 个 四 元 数 相 加 时 ， 将 对 应 的 元 素 分 别 相 加 。 
因此 ， 算 子 的 作用 像 分 离 器 。 对 于 加 法 ， 空 元 素 为 
四 元 数 0=0 + 0i+07+0k。 四 元 数 的 相 加 符合 结合 
律 、 交 换 律 和 分 配 律 。 对 于 乘法 ， 空 元 素 为 四 元 数 
I=1+0i+07+0k。 对 于 任意 四 元 数 ， 有 le=E 成 
立 。 四 元 数 的 相 乘 符合 结合 律 和 分 配 律 ， 但 不 符合 交 
换 律 。 由 算 子 规则 和 加 法 ， 得 到 四 元 数 的 相 乘 形 式 : 
ab =a,b —a,b, 一 ap —a,6, + 

(a,b, taibo + a,b, —a,b,)i+ (1.6) 

(a,b, + a,b +a,b, - a,b; )j + 

(a,b, + azb +a,b, — a,b, )k 
定义 四 元 数 的 补 

E =£ — 61 -Ej -ek 


因此 ， 


~ 2 2 2 2 
EE = €€=&) tE tE, tE 
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一 个 单位 四 元 数 定义 为 e& =1。 通 常 ，s, 称 为 四 元 数 
RIEL PRBS}, Ce, e, e) 称 为 矢量 部 分 。 

单位 四 元 数 用 于 描述 姿态 ， 其 单位 模 长 为 用 于 解决 
元 余 坐 标 (4 坐标) 的 辅助 关系 。 以 四 元 数 定义 的 矢量 
为 so =0 的 四 元 数 。 因 此 ,矢量 p = (p。 p, p) 可 以 
表 未 为 四 元 数 p =p,i +p, j+p,k。 对 于 任意 单位 四 元 数 
E, PE 多 执行 的 是 矢量 p 绕 (le gs。 a) 方向 的 
旋转 ， 这 可 以 通过 展开 gpz 并 比较 表 1. 1 中 的 等 价 旋 
转 和 矩阵 验证 。 如 表 1.3 所 示 ， 单 位 四 元 数 与 角 - 轴 姿 
态 表 示 密 切 相 关 ，so 代表 了 转角 ,而 es ©. ©, 代 
表 了 转轴 。 

对 于 速度 分 析 ， 四 元 数 对 时 间 的 导数 可 与 角速度 


矢量 建立 联系 : 
Eg =E] -E 一 £4 
. wy 
£1 Eo EJ -E 
=> w, (1.7) 
E> — &3 Eo £1 v 
È, £2 El Eg 


当 一 个 单位 四 元 数 仅 表示 一 个 物体 的 姿态 时 ， 四 
元 数 可 以 被 二 元 化 ”为 一 个 描述 物体 空间 位 置 和 
姿态 的 代数 式 。 其 他 复合 式 表示 将 在 后 面 介绍 。 


12.3 齐 次 变换 


前 面 分 别 介绍 了 位 置 和 姿态 的 表示 。 利 用 齐 次 变 
H, 位 置 矢量 和 旋转 矩阵 可 以 用 更 加 简洁 的 方式 结合 
在 一 起 。 如 果 i 坐标 系 相 对 于 j 坐标 系 的 位 置 和 姿态 
已 知 ， 那 么 i 坐标 系 中 的 任 一 矢量 ir 也 可 以 表示 为 j 
坐标 系 中 的 矢量 。 利 用 1.2. 1 节 中 的 符号 ， 坐 标 系 i 
的 原点 相对 于 坐标 系 j7 的 位 置 可 表示 为 失 量 ip, = 
Cp; /p /pi)"。 利 用 1.2.2 节 中 的 符号 ， 坐 标 系 i 
相对 于 坐标 系 j 的 姿态 可 用 及, 表示 。 这 样 ， 

ir =R; r +p, (1.8) 
该 方程 可 重 写 为 


(1.9) 
其 中 


(1.10) 


是 4 x4 的 齐 次 变换 和 矩阵。(Cr 1) 和 ('r 1) 是 位 
BRE’ Ar WKAR. ERFT, 将 坐标 系 i 中 的 
矢量 变换 为 坐标 系 j 中 的 矢量 ， 其 逆 和 矩阵 了 "将 坐标 
系 j 中 的 矢量 变换 为 坐标 系 i 中 的 矢量 。 
iR; —/R; r) 


: (1.11) 
0 1 


ito} ='T, -| 


4x4 齐 次 变换 矩阵 的 代数 运算 只 是 简单 的 矩阵 相 乘 ， 
正如 3 x3 BORER RE RE, A, AT, =*T, IT, R 
立 。 由 于 第 阵 乘法 不 能 交换 ， 所 以 其 顺序 非常 重要 。 

绕 一 个 轴 的 纯 旋转 的 齐 次 变换 有 时 记 为 Rot, F 
是 ， 绕 轴 z 旋转 9 角度 记 为 


cos -sinf 0 0 
~ sin? cos@ 0 0 
Rot(z, 6) = 0 0 1 0 (1.12) 
0 0 O i 
类 似 地 ， 沿 一 个 轴 的 纯 平移 有 时 记 为 Trans。 于 
是 , Meh x 平移 d 记 为 ~ 
1 0 O d 
Trans(x, d) = 9100 (1.13) 
0 0 1 0 
000 1 


当 希 望 符号 简洁 时 ， 当 编程 的 容易 程度 是 最 需要 
考虑 的 因素 时 ， 齐 次 变换 是 特别 具有 吸引 力 的 。 但 
是 ， 由 于 它 引 入 了 大 量 含 有 0 和 1 的 附加 乘法 运算 ， 
所 以 它 并 不 是 一 种 计算 效率 好 的 表示 。 尽 管 齐 次 变换 
HERA 16 TIGR, (HA 4 个 元 素 被 定义 为 0 或 1， 
剩余 的 元 素 则 包括 一 个 旋转 矩阵 和 -一 个 位 置 矢量。 因 
此 ， 真 正 的 宛 余 坐 标 来 自 旋转 矩阵 部 分 ， 相 应 的 辅助 
关系 也 与 旋转 矩阵 有 关 。 


1.2.4 旋 量 变换 


式 (1.8) 的 变换 可 以 看 作 是 坐标 系 i 和 坐标 系 7 
之 间 旋 转 和 偏 移 的 复合 变换 。 从 坐标 系 i 变换 到 坐标 
系 7 时 ， 应 先进 行 旋转 再 进行 仿 移 ， 反 之 亦 然 。 再 
者 ， 了 只 纯 平移 之 外 ， 两 个 坐标 系 之 间 的 偏 移 可 以 表示 
为 绕 特 定 直 线 的 旋转 和 沿 该 直线 的 纯 平移 。 

1. Chasles 定理 

Chirikjian 和 Kyatkin!' * 给 出 的 Chasles TH, H 
两 部 分 构成 。 

第 一 部 分 为 : 物体 在 空间 中 的 任 一 偏 移 可 以 认为 
由 平移 和 旋转 组 成 ， 即 指定 点 从 初始 点 到 终点 的 纯 平 
移 ， 以 及 物体 绕 指定 点 使 之 到 达到 终点 姿态 的 旋转 。 

第 二 部 分 为 : 物体 在 空间 中 的 任 一 偏 移 可 以 表示 
为 绕 空 间 特 定 直线 的 旋转 和 沿 该 直线 的 纯 平 移 。 该 直 
线 称 为 旋 量 轴 ， 是 Chasles 定理 的 第 二 个 结论 。 

Chasles 定理 的 第 一 部 分 是 显而易见 的 。 在 欧 几 
里 德 空间 中 物体 上 的 任意 一 个 指定 点 ， 可 以 被 从 一 个 
给 定 的 初始 位 置 转移 到 一 个 给 定 的 终点 位 置 。 更 进 一 - 
步 ， 物 体 上 的 所 有 点 作 同 样 的 偏 移 ， 则 物体 进行 了 平 
移 ， 指 定点 也 就 从 其 初始 位 置 移动 到 其 终点 位 置 。 然 
后 ， 物 体 可 绕 指 定点 旋转 到 任意 给 定 的 终点 姿态 。 
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Chasles 定理 的 第 二 部 分 依赖 于 空间 俩 移 的 表示 ， 
需要 进行 更 为 复杂 的 论证 。 欧 拉 的 一 个 预备 定理 可 以 
更 加 明确 地 说 明 物 体 的 旋转 : 物体 保持 一 点 固定 的 任 
何 偏 黎 ， 等 价 于 物体 绕 通 过 该 固定 点 的 一 个 特定 轴 的 
旋转 。 几 何 上 ， 在 运动 物体 的 三 个 嵌入 点 中 ， 奉 有 一 
点 在 旋转 时 是 固定 点 ， 则 其 他 两 点 中 的 任何 一 点 将 有 
初始 位 置 和 终点 位 置 。 连 接 其 初始 位 置 和 终点 位 置 形 
成 一 条 直线 段 ， 该 直线 段 的 中 垂 面 必 然 通过 上 述 固定 
点 。 在 一 个 中 垂 面 上 的 任意 一 条 直线 均 可 能 是 含有 相 
应 点 的 初始 位 置 和 终点 位 置 的 旋转 的 旋转 轴 。 因 此 ， 
两 个 中 垂 面 的 唯一 公共 线 即 为 包含 物体 上 任意 点 的 初 
始 位 置 和 终点 位 置 的 旋转 的 旋转 轴 。 刚 体 的 刚性 条 
件 ， 决 定 了 物体 上 包含 上 述 旋转 轴 直 线 的 所 有 平面 旋 
转 了 相同 的 角度 。 

欧 拉 定 理 指出 ， 对 于 由 人 妨 , 描述 的 一 个 刚体 的 任 
意 旋 转 ， 存 在 唯一 的 特征 矢量 使 得 


iRW=w (1.14) 


stp, w 是 一 个 平行 于 旋转 轴 的 单位 矢量 。 该 表达 式 
说 明 , OR, 有 一 个 单位 特征 矢量 对 应 于 特征 矢量 w。 
剩余 的 两 个 特征 矢量 为 cosg ising, HP i 是 复数 操 
作 符 ，9 是 物体 绕 旋 转轴 的 旋转 角 。 

结合 Chasles 定理 的 第 一 部 分 和 殉 拉 定理 ， 一 个 
通用 的 空间 偏 移 可 以 表示 为 将 一 个 点 从 初始 位 置 移动 
AA HU BALE, Li BORA pee Asia oh BA 
点 姿态 的 、 绕 着 通过 该 点 的 特定 轴 的 特定 旋转 。 将 平 
移 分 解 为 沿 轴 向 和 垂直 于 轴 向 的 分 量 ， 则 物体 上 任 一 
点 在 轴 向 上 具有 相同 的 偏 移 量 ， 这 是 因为 旋转 不 影响 
轴 向 分 量 。 向 垂直 于 轴 向 的 平面 投影 ， 则 偏 移 的 运动 
几何 与 该 平面 的 运动 相同 。 正 如 在 平面 上 有 唯一 的 一 
个 点 ， 使 得 物体 能 够 绕 着 该 点 在 两 个 给 定 的 位 置 间 旋 
转 ， 在 投影 平面 上 也 具有 唯一 的 一 个 这 样 的 点 。 正 如 
上 述 定 理 所 言 ， 若 旋转 轴 通 过 该 点 移动 ， 则 线 该 轴 的 
旋转 形成 的 空间 偏 移 受 加 了 一 个 沿 该 轴 的 平移 。 

旋转 所 绕 的 直线 称 为 偏 移 的 旋 量 轴 。 线 性 位 移 d 
对 旋转 角 6 的 比率 称 为 旋 量 轴 的 距 ht 。 

d=hé (1.15) 

纯 平移 的 旋 量 轴 不 是 唯一 的 。 由 于 平移 的 旋转 角 为 
0° ， 所 以 任何 平行 于 平移 方向 的 直线 均 可 认为 是 旋 量 
轴 ， 其 距 为 无 穷 大 。 


利用 平行 于 旋 量 轴 的 单位 矢量 w 和 在 旋 量 轴 上 
任意 点 的 位 置 拓 量 p， 可 最 方便 地 表示 任意 参考 坐标 
系 中 的 旋 量 轴 。 附 加 的 距 h 和 旋转 角 9， 完 整地 定义 
了 第 二 个 坐标 系 相 对 于 参考 坐标 系 的 位 姿 。 因 此 ， 共 
有 8 个 坐标 定义 一 个 旋 量 变换 ， 其 中 两 个 为 元 余 的 。 


w 的 模 是 一 个 辅助 关系 ,但 通常 没有 第 二 个 辅助 关 
系 。 这 是 由 于 同一 个 旋 量 轴 是 由 在 其 上 面 的 所 有 点 定 
义 的 ,或 者 说 矢量 p 仅 含 有 一 个 自由 坐标 。 

代数 上 ， 旋 量 偏 移 表示 为 

ir = R, (r -p) + dW +p 
比较 该 式 与 式 (1.8), A 

ip, =dw + (15,3 -—/R)p (1.17) 
其 中 ，1; 是 3 x3 的 单位 矩阵 。 方程 的 两 边 与 w 进 
行内 积 ， 容 易 得 到 d 的 表达 式 。 

d=w"p, (1. 18) 

矩阵 1s -这 ;是 奇异 的 ， 故 由 式 (1.17) 不 能 求解 
H p 的 唯一 值 。 但 由 于 p 可 表示 旋 量 轴 上 的 任意 点 ， 
所 以 情况 并 非 如 此 。p 的 一 个 元 素 可 以 任意 选择 ， 而 
且 利 用 分 量 方程 中 的 任意 两 个 方程 ， 可 以 求解 得 到 p 
的 另外 两 个 元 素 。 然 后 ， 在 旋 量 轴 上 的 所 有 其 他 点 可 
以 由 p +kw fie, Hk BER. 

表 1.4 给 出 了 旋 量 变换 与 齐 次 变换 之 间 的 转换 关 
系 。 值 得 注意 的 是 ， 旋 量变 换 的 等 价 旋转 矩阵 ， 与 表 
1. 1 中 资 态 的 角 - 轴 表示 的 等 价 旋转 和 矩阵 相同 。 此 外 ， 
在 表 1.4 中, 利用 矢量 p 与 旋 量 轴 正 交 (wp =0) 
这 一 辅助 关系 ， 以 提供 齐 次 变换 到 旋 量变 换 的 唯一 转 
He, HAR, BVA HEA BOR Re ERE R, 和 
平移 P, ， 采 用 Rodrigues 方程 求 取 。 

表 1.4 旋 量 变换 与 齐 次 变换 之 间 的 转换 ， 


缩写 cv, =co0s0, s, =sin0, v, =1—cosé 


旋 量 变换 到 齐 次 变换 : 


wv, +, 
IR, =| ww,ve 十 20z368 


(1. 16) 





2 
W,Ug tly WW Ug 一 WS 


2 
w, Vg + Cg 


ip; = (13x3 -/R;)p + how 





齐 次 变换 到 旋 量 变换 ; 


732 一 723 
{=| rl3 一 73l 
Fay — 142 


d= sign( {Tp;) 





iy Hra + Tag -| 
arccos | 一 -一 -一 一 一 
(Ás 
"Ip, 
T 26sing 
(1; x3 -iR} XVP; 
p= 2(1 —cos@) 
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物体 上 任 一 点 在 旋 量 偏 移 下 的 初始 和 终点 位 置 如 
图 1.1 所 示 。 





图 1.1 物体 上 任 一 点 在 旋 量 偏 移 下 的 初始 和 终点 位 置 
图 1.1 p, 'r 是 该 点 相对 于 运动 坐标 系 i 的 位 置 ， 
在 初始 位 置 时 ， 运 动 坐标 系 与 固定 参考 坐标 系 j 一 
致 ; 人 是 运动 物体 进行 旋 量 偏 移 后 该 点 相对 于 固定 

坐标 系 7 的 位 置 


2. Rodrigues 方程 

给 定 一 个 旋 量 轴 、 物 体 绕 该 轴 的 角 偏 移 和 物体 
沿 该 轴 的 平移 ， 则 物体 上 任 一 点 的 偏 移 可 以 求解 。 
震 将 一 个 和 矩阵 变换 看 做 是 物体 偏 移 的 描 述 ， 则 求解 
旋 量 偏 移 等 价 于 求解 与 给 定 旋 量 偏 移 等 价 的 矩阵 
变换 。 i 

参见 图 1. 1， 一 个 点 在 旋 量 偏 移 前 后 的 位 置 矢量 
具有 以 下 几何 联系 

ir =ir+dw+singow x (‘r-p) - 

(1 - cos) (‘r-p) - (‘r~-p) -ww (1.19) 

式 中 ,r Ar 分别 表示 该 点 的 初始 和 终点 位 置 , Alp 
表示 旋 量 轴 ,， 9 和 4d 给 出 了 其 偏 移 量 。 该 结果 称 为 
Rodrigues FÆ? ， 可 重 写 为 矩 隆 变换 形式 [ai 
(1.20) 
A (1.20) 展开 后 ， 得 到 含有 'r 和 的 元 素 的 三 个 线 
性 方程 : 


2 
WU, + ly 


jp —/ pi J 
r= Rr +p; 


W,W Dg — WS, W, W, Vg + W,S, 


j 2 
’R, =| W, W, Vg +w,se WU, + Cy W,W,V_g — Wasp 


2 


ip; = (15,3 -'R;)p + how 
式 中 ， 缩 写 cv =cosé, s,=sind, va =1 — cosh, AER 
PF Ree MIR, 又 称 为 旋 量 和 矩阵 ， 这 些 方程 给 出 的 


iR, Ap: 的 元 素 称 为 旋 量 参数 。 
纯 平 移 是 一 种 特殊 情况 ， 此 时 2 = 0， Rodrigues 
方程 变 为 


ir=ir +dw 
这 种 情况 下 , IR; =1;,5, ip; = dw。 
关于 旋 量 理论 的 进一步 信息 参见 参考 文献 
[1.11-15]。 


1.2.5 和 矩 阵 指数 参数 化 


物体 的 位 置 和 姿态 也 可 以 用 指数 表示 为 统一 的 格 
式 。 该 方法 首先 被 引入 纯 旋 转 ， 进 而 扩展 到 刚体 的 运 
动 。 该 方法 的 细节 参见 参考 文献 (1.16, 17], 

1. 旋转 的 指数 坐标 

所 有 行列 式 为 1 的 三 阶 正 交 和 矩阵 的 集合 ， 即 所 有 
旋转 矩阵 R 的 集合 ， 是 矩阵 乘法 操作 的 一 个 群 ， 记 
为 S0(3) CR 。 它 代表 特殊 的 正 交 ， 其 特殊 
之 处 在 于 R 的 行列 式 为 +1 而 不 是 + 1。 该 旋转 矩阵 
的 集合 符合 一 个 群 的 下 述 4 个 公理 : 

闭 包 性 : RR eS0(3) VR,, R, e SO(3)。 

一 致 性 : l; R = 及 13 3 =R VReSO(3), 

AYE; R eS0(3) ER KME—B VR e s03). 

结合 性 : (R,R,)R,=R,(R,R,) WR,, R, R, 
e SO(3), 

在 1.2.2 节 的 角 - 轴 表示 中 ， 姿 态 表示 为 绕 单 位 


矢量 w 旋转 角度 9。 表 1. 1 中 的 等 价 旋转 矩阵 可 以 表 
示 为 指数 形式 


R =e5? =1 , +0S(w) LESO) + 


(1.21) 


OP op ay3 
zS) Bi eas (1.22) 
RP, S (w) 为 斜 对 称 和 矩阵 。 
0 -u WwW, 
S(w) =| », 0 -w, (1.23) 
-w w 0 


¥ x 


于 是 ， 上 述 指数 表达 式 将 对 应 于 转轴 的 斜 对 称 矩 阵 
S(w) 转换 成 了 对 应 于 绕 轴 w 旋转 角度 9 KESER 
R。 更 有 利于 计算 的 es*”? 的 闭 式 解 为 
es(9)6 Is +S(w)sing+S(w)7(1—cos@) (1.24) 
(ow, Ow, Ow,) 的 元 素 与 表 1.2 中 旋转 矩阵 R 的 元 
HK, PAR 的 指数 坐标 。 
2. 刚体 运动 的 指数 坐标 
正如 在 1.2.3 节 所 指出 的 ， 物 体 的 位 置 和 姿态 可 
以 由 位 置 矢量 Ps R” 和 旋转 矩阵 Re S50(3) 表示 。 
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R 与 S0(3) 的 积 空 间 称 为 SE(3) BH, SE 代表 特殊 
欧 几 里 德 空间 (special Euclidean)。 
SE(3) ={|(p,R): peR’, Re SO(3)| 
=R? x S0(3) 
齐 次 变换 的 集合 符合 一 个 群 的 下 述 4 个 公理 : 
HEH: T T, eSE(3) VYT, Te SE(3); 
一 致 性 : 1.3T=T 1,,,=T YTesE(3); 
可 道 性 ; TRAM RX, WA (1.11) YT 
e SE(3); 
结合 性 : (TT,)T, =T, (TD) 
e SE(3). 
在 1.2.4 节 的 旋 量 变换 表示 中 ， 位 置 和 姿态 利 
用 绕 单位 矢量 w 定义 的 旋 量 轴 旋 转 的 角度 6、 在 旋 


量 轴 上 的 点 p 和 旋 量 轴 的 距 h 表示 ,其 中 Wip = 0。 
其 等 价 的 齐 次 变换 矩阵 ， 见 表 1.4， 也 可 表示 为 指 
数 形式 


VT,, 72 ， T; 


2 ~ (£0)? (#0)’ 
= of? = S0) A80 l 
T= 1,., +€0+ T + 31 + (1.25) 
其 中 
i r) (1.26) 
07 0 


是 单位 斜 对 称 矩 阵 的 通用 化 表达 式 ， 称 为 扭曲 
(twist) 。 的 扭曲 坐标 记 为 = Co" v)" of HORA 
式 表达 式 为 


oie E p (1,5 一 es(”)9 (w xv) +w' vow | 


0" 0 
(1.27) 
将 上 述 结果 与 表 1.4 中 的 齐 次 变换 和 旋 量 变换 之 间 的 
转换 相 比 较 ， 有 
y=p xw (1.28) 
H 
h=W'v (1.29) 
于 是 ,利用 扭曲 的 指数 形式 ， 将 物体 的 初始 姿态 变换 
到 了 终点 姿态 。 它 给 出 的 是 刚体 的 相对 运动 。 矢 量 
Eo 含有 刚体 变换 的 指数 坐标 。 
对 于 旋 量变 换 ， 纯 平移 的 情况 是 独特 的 。 此 时 ， 


w =0， 于 是 
i? _ p x3 "| 
oO 1 


1.2.6 Pliicker 坐标 


(1. 30) 


定义 一 条 空间 直线 最 少 需要 四 个 坐标 。 直 线 的 


Pliicker 坐标 是 一 个 6 维 矢量 ， 其 元 余数 为 2。 直 线 的 
Pliicker 坐标 可 以 认为 是 一 对 3 维和 撩 量 ， 一 个 平行 于 
直线 ， 另 一 个 是 矢量 对 原点 的 转 和 矩 。 于 是 ， 如 果 下 是 
任 一 平行 于 直线 的 矢量 , p 是 直线 上 任意 点 相对 于 原 
点 的 位 置 ， 则 Pliicker 坐标 (L, M, N, P, Q, R) 
如 下 : 

(L, M, N) =u"; (P, Q, R)=(pxu)" (1.31) 
对 于 简单 定义 的 一 条 直线 , u 的 幅 值 既 不 唯一 ，P 的 
分 量 也 不 平行 于 w。 两 个 辅助 关系 是 隐 含 的 ， 它 们 将 
Pliicker 坐标 集 降低 为 4 个 独立 坐标 。 一 个 辅助 关系 
为 : 两 个 3 维 矢量 的 标量 积 恒 等 于 0。 

了 P+MO+ANR=0 (1. 32) 
另 一 个 辅助 关系 为 : 所 有 坐标 分 量 同 乘 以 一 个 系数 时 
指定 直线 的 不 变性 。 
(L, M, N, P, QO, R)=(kL, kM, kN, kP, kQ, kR) 
(1.33) 
该 关系 也 可 采用 含有 单位 模 长 的 w 的 形式 ， 此 时 工 、 
M 和 为 方向 余弦 。 
本 手册 中 ， 常 用 Plicker 坐标 表示 速度 ， 但 与 直 
线 的 定义 不 同 的 是 ， 两 个 矢量 的 幅 值 不 是 任意 的 。 
由 此 产生 了 von Mises[L91] 和 Everettt* ”的 矢量 符 
号 。 对 于 了 瞬时 一 致 的 两 个 坐标 系 ， 一 个 为 固定 坐标 
系 ， 另 一 个 为 附着 于 运动 物体 的 运动 坐标 系 ， 以 w 
表示 物体 相对 于 固定 坐标 系 的 角速度 ， 以 vo 表示 物 
体 的 运动 坐标 系 的 原点 0 相对 于 固定 坐标 系 的 速 
度 。 这 样 ， 就 为 物体 的 空间 速度 + 提供 了 Pliicker 坐 
标 系 统 。v 的 Plicker 坐标 就 是 的 w 和 vo WH FIL 


坐标 。 
w 
y= 
(», 


空间 速度 从 Plucker 坐标 系统 i 到 Pliicker 坐标 系 
统 j 的 变换 ， 由 空间 变换 / 素 ; 实现 。 如 果 利 用 六 和 vy 
代表 物体 相对 于 坐标 系 i 和 j 的 空间 速度 , ip; AR, 代 
KERA i 相对 于 坐标 系 j 的 位 置 和 姿态 ， 则 


(1. 34) 


V; =i Xv, (1. 35) 
其 中 
iR, 0,, 
ix=| 5 OM (1. 36) 
S(/p;)’R, iR. 
于 是 
iR, 0,、 
xt six s{ 7 “| (1.37) 
7 'RSCP:) 'R, 
H. 
*X, ='X, /X, (1.38) 


S(ip;) 是 斜 对 称 和 矩阵 
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0 -ip: 去 
pCO -ip (1.39) 
-p ip 0 


空间 矢量 符号 ， 包 括 此 处 简要 介绍 的 空间 速度 和 
变换 ， 将 在 2. 2 节 中 进行 深入 探讨 。 特 别 地 ， 表 2.1 
给 出 了 一 种 采用 空间 变换 的 高 计算 效率 的 算法 。 


1.3 关节 运动 学 


除非 明确 指出 ， 否 则 ， 机 器 人 机 构 运 动 学 的 描述 
都 进行 了 一 系列 的 理想 化 假设 。 构 成 机 构 的 连 杆 ， 假 
设 是 严格 的 刚体 ， 其 表面 无 论 位 置 还 是 形状 在 几何 上 
都 是 理想 的 。 相 应 地 ， 这 些 刚 体 由 关节 连接 在 一 起 ， 
关节 也 具有 理想 化 的 表面 ， 其 接触 无 间隙 。 这 些 接触 
面 的 相应 几何 形状 决定 了 两 个 连 杆 间 的 运动 自由 度 ， 
或 者 关节 运动 学 。 

一 个 运动 学 意义 上 的 关节 是 两 个 物体 之 间 的 连 
接 ， 它 限制 了 两 个 物体 间 的 相对 运动 。 相 互 连 接 的 两 


表 1.5 单 自 由 度 低 副 关 节 模 型 公式 (缩写 Ca 一 cos, » Sa = sind; 


个 物体 构成 一 个 运动 关节 。 两 个 物体 相互 接触 的 表面 
能 够 相互 运动 ， 从 而 允许 两 个 物体 之 间 的 相对 运动 。 
简单 运动 关节 分 为 两 类 ， 分 别 为 面 接触 的 低 副 关 
节 “” 和 点 或 线 接触 的 高 副 关节 。 

关节 模型 描述 关节 的 一 个 物体 上 的 固定 坐标 系 相 
对 于 男 一 个 物体 上 的 固定 坐标 系 之 间 的 运动 。 该 运动 
用 关节 运动 变量 和 关节 模型 的 其 他 元 素 的 函数 进行 表 
达 ， 关 节 模 型 包括 了 旋转 矩阵 、 位 置 矢量 、 自 由 模 数 
和 受 限 模 数 等 。 一 个 关节 的 自由 模 数 是 其 允许 运动 的 
方 同 数 ， 以 6 xn, 的 矩阵 D, 表示 ， 其 列 为 允许 运动 
的 Plücker 坐标 。 该 矩阵 建立 了 通过 关节 的 空间 速度 
ve IKTE g 的 联系 ， 

va = Dg (1.40) 

相应 地 ， 一 个 关节 的 受 限 模 数 是 其 不 允许 运动 的 方向 
数 ， 以 6 x (6 -n) 的 D, HIERE D RR HLS 
和 表 1.6 给 出 了 本 节 描 述 的 所 有 关节 的 关节 模型 公 
式 ， 它 们 将 进一步 用 于 第 2 章 的 动力 学 分 析 。 关 于 关 
季 的 进一步 信息 参见 第 3 章 。 


(部 分 来 源 于 参考 文献 [1.21] 的 表 4.1)) 


关节 类 型 | 关节 旋转 矩阵 iR 


0 
9 
0 
a 
RER Lacs e) 
P d, 


螺旋 式 


旋转 式 
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表 1.6 高 自由 度 低 副 关节 模型 公式 (FS cy, =cosd,, sq =sind, (部 分 来 源 于 
参考 文献 [1.21] 的 表 4. 1) ， 欧 拉 角 a;，B;，Y; 可 用 于 替换 单位 四 元 数 e 表示 姿态 ) 






平面 式 






(Cite: — spdy 
区 十 2 
0 
TBicp — 5g; 
| —rOise — reo | 
0 











有 6 种 可 能 的 形式 : REAK, RERE, REA 


1.3.1 REKT 的 、 柱 面 式 的 、 球 面 式 的 和 平面 式 的 关节 。 
低 副 关节 在 机 械 上 具有 吸引 力 ， 因 为 其 磨损 分 布 L 旋转 式 
于 整个 表面 ， 而 且 润 滑 剂 被 密封 于 两 个 表面 的 小 间 阶 旋转 式 关节 常 缩写 为 “R”， 有 时 也 俗称 馈 链 或 


空间 (在 非 理想 化 的 系统 中 ) ， 能 够 形成 相对 较 好 的 。 栓 销 。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 旋转 表面 构 
润滑 。 由 表面 接触 的 需求 可 以 证 明 '"” ， 低 副 关节 只 ”成 的 低 副 关节 。 两 个 旋转 表面 是 相同 的 ， 只 不 过 一 个 
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为 外 表面 ， 法 线 指 向 转轴 的 任意 面 ， 且 是 凸 的 ， 另 一 
个 为 内 表面 ， 法 线 指向 转轴 的 任意 面 ， 且 是 目的。 这 
些 表 面 并 非 仅 仅 是 圆柱 表面 ， 因 为 仅 靠 圆柱 表面 不 能 
提供 轴 向 的 滑动 限制 。 旋 转 式 关节 仅 允 许 相互 连接 的 
一 个 物体 相对 于 另 一 个 物体 旋转 。 一 个 物体 相对 于 另 
一 个 物体 的 位 置 ， 可 以 利用 指向 关节 轴 的 两 条 法 线 的 
夹 角 表 示 ， 其 中 ， 每 条 法 线 固定 于 一 个 物体 。 因 此 ， 
该 关节 具有 一 个 自由 度 。 当 旋转 关节 轴 设 定 为 坐标 系 
iA 2 轴 时 ， 旋 转 关 节 的 模型 见 表 1. 5。 

2. 棱柱 式 

棱柱 式 关节 常 缩写 为 “P”， 有 时 也 俗称 滑动 关 
T。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 柱 面 构成 的 低 
副 关 节 。 这 些 表面 并 非 一 定 是 圆柱 表面 ， 通 常 ， 一 个 
柱 面 可 以 由 任意 曲面 沿 一 定 方向 挤 压 而 成 。 同 样 ， 楼 
柱 式 关节 也 有 一 个 内 表面 和 一 个 外 表面 。 楼 柱 式 关节 
仪 介 许 相互 连接 的 一 个 物体 相对 于 另 一 个 物体 沿 挤 压 
方向 滑动 。 沿 平行 于 滑动 的 方向 在 两 个 物体 上 各 选 一 
个 固定 点 ， 则 一 个 物体 相对 于 另 一 个 物体 的 位 置 由 这 
两 点 间 的 距离 确定 。 因 此 ,该 关节 具有 一 个 自由 度 。 
当 楼 柱 式 关节 轴 设 定 为 坐标 系 i 的 2 轴 时 ， 楼 柱 式 关 
节 的 模型 见 表 1. 5。 

3. 螺旋 式 

螺旋 式 关节 常 缩写 为 “H”， 有 时 也 俗称 螺杆 关 
7。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 螺旋 面 构成 的 
低 副 关节 。 螺 旋 面 可 以 由 任意 曲面 沿 螺旋 路 径 挤 压 而 
成 。 最 简单 的 例子 是 螺杆 和 螺母 ， 其 基本 母 曲 线 是 一 
对 直线 。 螺 旋 角 9 与 一 个 物体 相对 于 另 一 个 物体 沿 轴 
RAMEE d 相关 ， 可 表示 为 d =he, BHR KA 
距 。 当 螺旋 关节 轴 设 定 为 坐标 系 i 的 2 轴 时 ,螺旋 关 
节 的 模型 见 表 1. 5。 

4. 柱 面 式 

柱 面 式 关节 党 缩写 为 “C”， 是 由 两 个 全 等 的 圆 
柱 面 构成 的 低 副 关节 ， 其 中 一 个 为 内 表面 ， 另 一 个 为 
外 表面 。 柱 面 式 关节 人 允许 绕 柱 面 轴 的 旋转 和 沿 平行 于 
柱 面 轴 的 平移 。 因 此 ， 它 是 一 个 两 自由 度 关节 。 在 运 
动 学 上 ， 多 于 一 个 自由 度 的 低 副 关节 可 以 利用 复合 关 
节 等 价 蔡 换 (参见 1.3.3 节 )， 即 多 个 单 自 由 度 低 副 
关节 构成 的 串联 链 。 在 此 情况 下 ， 柱 面 式 关 节 可 以 等 
价 为 一 个 旋转 式 关 节 和 一 个 棱柱 关节 的 串联 ， 且 楼 柱 
关节 的 滑动 方向 平行 于 旋转 轴 。 采 用 1.4 节 讨 论 的 几 
何 表示 实现 简单 ， 但 该 方法 不 利于 动态 仿真 。 将 柱 面 
式 关 节 作 为 棱柱 关节 和 旋转 关节 的 结合 体 进行 建 模 
时 ， 知 要 在 校 柱 关节 和 旋转 关节 之 间 增 加 虚拟 轴 ， 虚 
拟 轴 的 长 度 和 质量 为 零 。 但 无 质量 连 杆 会 产生 计算 问 
题 。 当 柱 面 式 关节 轴 设 定 为 坐标 系 i 的 z 轴 时 ， 柱 面 


式 关 节 的 模型 见 表 1. 6。 

5. 球面 式 

球面 式 关节 常 缩写 为 “$”， 是 由 两 个 全 等 的 球 
面 构 成 的 低 副 关节 。 同 样 ， 这 两 个 球面 的 一 个 为 内 表 
面 ， 另 一 个 为 外 表面 。 球 面 式 关节 人 允许 绕 通 过 球 心 的 
任意 直线 旋转 ， 因 此 ， 它 允许 最 多 绕 3 个 不 同方 向 的 
独立 旋转 ， 具 有 3 个 自由 度 。 在 运动 学 上 ， 球 面 式 关 
节 可 等 价 为 由 3 个 旋转 式 关节 构成 的 复合 关节 ，3 个 
旋转 式 关 节 绕 有 公共 点 的 3 个 轴 旋 转 。 尽 管 不 需要 3 
个 轴 连 续 正 交 ， 但 通常 是 采用 3 个 轴 连 续 正 交 的 方 
式 。 通 常 ， 上 述 排列 与 球面 关节 等 价 ， 但 在 旋转 式 关 
节 的 轴线 共 面 时 具有 奇异 性 。 这 与 实际 的 球面 关节 形 
成 对 比 ， 实 际 的 球面 关节 从 不 会 具有 奇异 性 。 类 似 
地 ， 如 果 将 球面 式 关节 仿真 建 模 为 3 个 旋转 关节 ， 由 
于 具有 3 个 长 度 和 质量 为 零 的 虚拟 轴 ， 会 导致 出 现 计 
算 困 难 问题 。 球 面 式 关节 的 模型 见 表 1. 6。 

6. 平面 式 

平面 式 由 含有 表面 的 平面 构成 。 类 似 于 球面 式 关 
T, 平面 式 关节 是 具有 3 个 自由 度 的 低 副 关节 。 其 运 
动 学 等 价 复合 关节 ， 由 3 个 绕 平 行 轴 旋 转 的 旋转 式 关 
节 的 串联 链 构 成 。 与 球面 式 关节 的 情况 类 似 ， 复 合 关 
节 在 旋转 式 关 节 的 轴线 共 面 时 具有 奇异 性 。 当 平面 式 
关节 的 接触 平面 的 法 线 设 定 为 坐标 系 i 2 BAT, 平 
面 式 关 节 的 模型 见 表 1. 6。 
高 副 关节 

某 些 高 副 关节 同样 具有 吸引 力 ， 特 别 是 一 个 物 
体 在 另 一 个 物体 表面 无 滑动 的 滚动 副 。 这 在 机 械 上 
具有 了 吸引 力 ， 因 为 没有 滑动 意味 着 没有 磨损 。 但 是 ， 
理想 的 接触 是 一 个 点 或 沿 着 一 条 线 ， 加 载 到 关节 的 
负载 可 能 会 引起 很 大 的 局 部 压力 ， 导 致 其 他 形式 的 
材料 失效 ， 因 而 损坏 。 高 副 关节 可 以 用 于 构造 具有 
特殊 几何 特性 的 运动 关节 ， 如 齿轮 副 或 凸轮 与 从 动 
轮 副 。 

滚动 接触 实际 上 包括 几 种 不 同 的 几何 形状 。 平 面 
运动 的 滚动 接触 允许 一 个 自由 度 的 相对 运动 ， 如 滚 柱 
轴承 。 如 上 所 述 ， 滚 动 接触 具有 令 人 满意 的 磨损 特 
性 ， 因 为 没有 滑动 意味 着 没有 磨损 。 平 面 滚动 接触 为 
线 接触 ， 因 此 能 够 稍微 分 散 负载 和 磨损 。 三 维 滚动 接 
触 允 许 绕 通过 接触 点 的 任意 轴 旋 转 ， 接 触 点 在 原理 上 
是 唯一 的 。 因 此 ， 三 维 滚 动 接触 副 允 许 3 个 自由 度 的 
相对 运动 。 当 将 过 半径 为 + 的 滚 轴 中 心 的 滚动 轴线 设 
定 为 坐标 系 守 的 2 轴 时 ， 对 于 一 个 在 平面 上 的 滚 轴 ， 
其 平面 滚动 接触 关节 的 模型 见 表 1. 6。 

无 论 滚动 接触 关节 是 平面 的 还 是 三 维 的 ， 与 滚动 
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接触 关节 相关 的 无 滑动 条 件 ， 要 求 两 个 物体 上 相互 接 
触 的 点 之 间 的 相对 瞬时 速度 为 0。 如 果 P 是 两 个 物体 
i 和 j 之 间 的 滚动 接触 点 ， 则 

Vpyp, =0 (1.41) 
类 似 地 ， 相 对 加 速度 位 于 接触 点 的 两 个 表面 的 公共 法 
线 方 向 上 。 由 于 与 关节 相关 的 约束 以 速度 的 形式 表 
示 ， 因 此 ， 该 约束 为 非 限定 性 约束 ， 人 参见 1.3.6 7, 
关于 滚动 接触 的 运动 学 约束 的 详细 讨论 ， 见 第 17 章 
17.2.2 节 。 


1.3.3 S4KR 


复合 运动 关节 是 由 多 个 简单 运动 关节 链 构 成 的 两 
个 物体 间 的 连接 。 与 简单 关节 一 样 ， 复 合 关节 也 可 以 
限制 两 个 物体 间 的 相对 运动 。 在 这 种 情况 下 ， 复 合 关 
节 与 简单 关节 在 运动 学 上 是 等 价 的 。 

TERREIN “U”, ARA FEREZ, 
是 一 个 具有 两 个 自由 度 的 关节 。 它 由 两 轴 正 交 的 两 个 
旋转 式 关 节 串 联 链 构成 。 万 向 节 模 型 见 表 1.6， 其 
P, KAH a; 是 绕 Z 轴 的 第 一 次 旋转 ，B; 是 绕 了 轴 
的 旋转 。 对 于 该 关节 而 言 ， 其 矩阵 OA ORB 


数 ， 通 常 ,0，B! 0。 在 此 情况 下 ， 外 部 参考 坐 
标 系 的 姿态 随 a 而 变化 。 


六 自由 度 关节 


两 个 不 连接 在 一 起 的 物体 的 运动 ， 可 以 建 模 为 
一 个 无 约束 的 六 自由 度 关节 。 这 对 于 移动 机 器 人 特 
别 有 用 ， 例 如 航空 器 ,最 多 间 吹 接触 地 面 ， 相 对 于 
固定 坐标 系 自由 运动 的 物体 称 为 浮动 基 座 。 这 样 一 
个 自由 运动 的 关节 模型 可 使 得 浮动 基 座 在 空间 中 的 
位 置 和 姿态 表示 成 六 关节 变量 。 六 自由 度 关 节 模 型 
见 表 1.6。 


1.3.5 物理 实现 


在 实际 的 机 器 人 机 构 中 ,关节 具有 物理 限制 ， 
超出 该 限制 的 运动 是 被 禁止 的 。 机 器 人 机 构 的 工作 
空间 ( 见 1.5 节 ) ， 是 在 考虑 到 机 构 中 的 所 有 关节 
的 物理 限制 和 自由 度 的 情况 下 确定 的 。 旋 转 式 关 市 
易于 由 旋转 式 电 动机 驱动 ， 因 而 在 机 器 人 系统 中 极 
为 常用 。 关 节 也 可 能 以 被 动 的 、 无 驱动 的 形式 呈现 ， 
这 些 形式 也 非常 常见 ,但 没有 旋转 式 关节 这 人 么 常见 。 
棱柱 关节 相对 来 说 易于 由 线性 驱动 器 驱动 ， 如 液压 
LMA. BRAHE, METAS. EBA 
有 运动 限制 ， 因 为 单 向 滑动 在 理论 上 可 产生 无 穷 大 
偏 移 。 螺 旋 关 节 在 机 器 人 机 构 中 也 较 常 见 ， 尽 管线 
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性 驱动 顺 如 螺旋 千斤 项 、 滚 珠 丝 杠 等 很 少 用 做 运动 主 
关节 。 上 有 具有 多 于 一 个 自由 度 的 关节 ， 在 机 器 人 机 构 中 
常用 做 被 动 关节 ， 这 是 因为 主动 关节 的 每 个 自由 度 需 
要 独立 驱动 。 在 机 器 人 机 构 中 ， 被 动 球 面 式 关节 很 常 
见 ， 但 被 动 平面 式 关节 仅 偶 有 所 见 。 驱 动 式 球 关节 ， 
利用 运动 学 上 等 价 为 三 个 旋转 式 关 亨 分 别 驱 动 实现 。 
万 向 节 在 机 器 人 机 构 中 跷 用 于 主动 关节 ， 又 用 于 被 动 
Ro 

串联 链 常 简 记 为 所 含 关节 的 顺序 。 例 如 ，RPR 
链 含 有 三 个 连 杆 ， 第 一 个 连 杆 通过 旋转 式 关 节 与 基 座 
连接 ， 第 二 个 连 杆 带 有 棱柱 式 关 节 ， 第 二 个 和 第 三 个 
连 杆 采 用 另 一 个 旋转 式 关 节 连 接 。 如 采 所 有 关 下 是 相 
同 的 ， 则 简 记 为 关节 数量 和 关节 类 型 ,例如 ，6R 表 
MRA 6 个 旋转 式 关节 的 六 轴 串 联 链 操作 需 。 

以 硬件 实现 关节 ， 要 比 1.3.1 节 和 1.3.2 节 给 出 
的 理想 化 情况 复杂 得 多 。 例 如 ， 一 个 旋转 式 关节 由 深 
珠 轴 承 实现 ， 而 滚珠 轴承 则 有 一 系列 封闭 于 两 个 轴 套 
之 间 的 轴承 滚珠 构成 。 滚 珠 在 轴 套 上 作 无 滑动 的 理想 
滚动 ， 充 分 利用 了 滚动 接触 的 特殊 特性 。 一 个 棱柱 关 
节 可 由 沪 轴 导轨 组 合 构 成 。 


1.3.6 限定 性 和 非 限 定性 约束 


除 滚动 接触 之 外 ， 上 文中 讨论 的 与 关节 相关 的 所 
有 约束 ， 可 以 在 数学 上 表示 为 仅 含有 关 广 位 置 变 量 的 
方程 ， 称 为 限定 性 约束 。 方 程 的 数量 即 约 东 的 数量 为 
6n, nn 为 关节 自由 度 的 数量 。 这 些 约束 是 轴 关 节 模 型 
的 固有 部 分 。 

非 限 定性 约束 是 不 能 单独 利用 位 置 变量 表达 的 
约束 ,但 含有 一 个 或 多 个 位 置 变量 对 时 间 的 导数 。 
不 能 通过 对 这 些 约束 方程 积分 ， 以 单独 获得 关节 变 
量 之 间 的 关系 。 机 器 人 系统 中 ， 最 常见 的 例子 来 目 
于 只 能 滚动 不 能 够 滑动 的 轮子 或 者 滚 轴 。 非 限定 性 
约束 ， 特 别 是 其 在 轮 式 机 器 人 的 应 用 ， 将 在 第 17 章 
详细 讨论 。 
广义 坐标 

在 由 六 个 物体 构成 的 机 器 人 操作 右 中 ， 需 要 ON 
个 坐标 以 便 指定 所 有 物体 相对 于 一 个 坐标 系 的 位 置 和 
姿态 。 由 于 这 些 物 体 中 有 一 些 是 连接 在 一 起 的 ， 所 以 
有 一 系列 的 约束 方程 建立 了 这 些 坐 标 之 间 的 关系 。 在 
此 情况 下 ，6N 个 坐标 可 以 表达 为 一 个 较 小 的 独立 坐 
标 集合 g 的 函数 。 该 集合 中 的 坐标 称 为 广义 坐标 ， 而 
与 其 相关 的 运动 与 所 有 的 约束 是 一 致 的 。 机 器 人 操作 
器 的 关节 变量 9， 是 广义 坐标 的 一 个 集合 “”” 。 
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1.4 几何 表示 


将 参考 坐标 系 附着 于 每 一 连 杆 ， 可 以 很 方便 地 定 
义 机 促 人 操作 句 的 几何 关系 。 这 些 坐 标 系 可 以 任意 设 
置 ， 但 坐标 系 设 置 在 连 杆 上 这 一 约定 有 利于 连贯 性 和 
计算 效率 。Denavit 和 Hartenberg! ”介绍 了 用 于 不 同 
方法 的 基本 约定 ， 其 中 之 一 是 本 手册 采用 的 Khalil 和 
Dombre'"”1 提 出 的 约定 。 在 所 有 的 形式 中 ， 该 约定 采 
用 四 参数 而 不 是 六 参数 确定 一 个 坐标 系 相 对 于 另 一 个 
坐标 系 的 位 姿 。 这 4 个 参数 分 别 是 : 连 杆 长 度 a,， 连 
杆 扭转 角 a, KEMBE d, KTA 9,。 上 述 简 约 参 
数 集 是 通过 下 述 方式 实现 的 : 通过 合理 配置 参考 坐标 
系 的 原点 和 各 个 轴 ， 使 得 一 个 坐标 系 的 % 轴 与 后 续 参 
考 坐 标 系 的 z 轴 相 交 并 垂直 。 该 约定 适用 于 由 旋转 式 
关节 和 棱柱 式 关节 构成 的 操作 器 。 当 存在 多 自由 度 关 
节 时 ,采用 旋转 式 关 节 和 楼 柱 式 关节 对 其 建 模 ， 如 
1.3 WAT. 

在 机 器 人 机 构 中 ， 主 要 有 4 种 不 同 的 参考 坐标 系 
配置 约定 ， 直 观 上 每 一 种 均 有 其 优势 。 在 Denavit 和 
Hartenberg! 的 原创 约定 中 ， 关 节 守 位 于 连 杆 ;和 
i+1 之 间 ， 在 连 杆 i 的 外 侧 。 同 样 ， 关 节 偏 移 量 d; 和 
关节 角 0, 分别 是 沿 着 或 绕 着 i -1 关节 轴 的 ， 所 以 关 
节 参 数 的 下 标 与 关节 轴 不 对 应 。Waldron!"” 和 
Paul!" ” 修正 了 原创 约定 中 轴 的 标号 ， He i 置 于 
连 杆 i-1 和 ji 之 间 ， 使 得 串联 链 的 基 座 标号 从 0 开 
Wo XF, KP i 配置 在 连 杆 i 的 内 侧 ， 这 也 是 所 有 
其 他 修正 版 本 的 约定 采用 的 方式 。Waldron 和 Paul 将 
z; 轴 配置 在 i+1 关节 轴 上 ， 进 一 步 解决 了 关节 参数 的 
下 标 与 关节 轴 不 对 应 的 问题 。 当 然 ， 这 也 重新 配置 了 
相应 于 关节 轴 和 参考 坐标 系 z 轴 的 下 标 不 对 应 问题 。 
Craig!" ”通过 将 # 轴 配置 在 关节 i 上 ， 删 除了 所 有 的 
不 对 应 下 标 ， 但 代价 是 齐 次 变换 矩阵 "'T, 由 下 标 为 i 
的 关节 参数 和 下 标 为 i -1 的 连 杆 参数 构成 。Khalil 和 
Dombre'"” 给 出 了 另 一 种 版 本 ,分 别 沿 着 和 绕 着 2, _, 
轴 定 义 a; 和 a;， 其 他 类 似 于 Craig 的 版 本 。 在 这 种 情 
AF, AKERE T, 完全 由 下 标 为 i 的 参数 构 
成 ， 但 下 标的 不 对 应 体现 为 另 一 种 形式 ，w Ma 3 
IRRE i -1 的 连 杆 长 度 和 扭转 角 ， 而 不 是 连 杆 i 
的 连 杆 长 度 和 扭转 角 。 总 之 ， 本 手册 中 用 的 约定 与 其 
他 约定 相 比 ， 其 优点 是 参考 坐标 系 的 z 轴 与 关节 轴 具 
有 相同 下 标 ， 定 义 从 参考 坐标 系 i 到 参考 坐标 系 i -1 
的 空间 变换 的 四 参数 具有 相同 的 下 标 io 


本 手册 中 ， 串 联 链 操作 器 的 约定 如 图 1.2 所 示 。 





图 1.2 机 器 人 机 构 中 的 物体 与 关节 的 编号 ， 物 体 上 坐标 
系 的 约定 ， 以 及 定位 一 个 坐标 系 相 对 于 另 一 个 坐标 系 的 
四 参数 .a; ~ Qis» d; AI 0; 的 示意 图 


物体 与 关节 的 编号 约定 如 下 : 

1) 机 器 人 机 构 中 的 入 个 运动 物体 从 1 Bl N Be 
号 ， 基 座 编号 为 0。 

2) BLAS AML Has N 个 关 市 从 1 到 编号 ， 关 
节 i 位 于 连 杆 i-1 Mi 之 间 。 

经 上 述 编号 后 ， 参 考 坐 标 系 约定 如 下 : 

1) 2 轴 配 置 在 关节 的 轴线 上 。 

2) Z ATF 2,_, PAA 2 RABE E.o 

采用 上 述 坐 标 系 后 ， 定 位 一 个 坐标 系 相对 于 男 一 
个 坐标 系 的 四 参数 定义 如 下 : 

1) a, ERA =,_ FM 2,_ OS) 2 EA o 

2) Q; ERA %;_1 轴 从 z_| 轴 旋转 到 z. 轴 的 转角 。 

3) d, 是 沿 着 z, 轴 从 %;.! 轴 到 %, 轴 的 距离 。 

4) 0, 是 绕 着 z: 轴 从 x;_, 轴 旋转 到 x, 轴 的 转角 。 

图 1.3 所 示 的 六 自由 度 串 联 链 式 操作 兹 实例 的 几 
何 参 数 见 表 1.7。 该 操作 器 的 所 有 关节 为 旋转 式 关 
节 ， 关节 1 垂直 向 上 上， 关节 2 与 关节 1 垂直 并 相交 。 
关节 3 平行 于 关节 2， 连 杆 2 的 长 度 为 cg 。 关 节 4 与 
关节 3 垂直 并 相交 。 关 节 5 与 关节 4 垂直 相交 ， 并 与 
关节 3 有 关节 偏 移 量 由 。 最 后 ， 关 节 6 与 关节 5 HH 
相交 。 





图 1.3 ABH RR REAR EH 
(E-DHA Tas AR A eK HH ) 


1.7 图 1.3 中 串联 链 式 操作 器 实例 的 几何 参数 


ð; 


T 
一 一 一 d 8 


在 该 约定 下 ， 通 过 绕 x,_, 轴 旋转 角度 a, W x,.， 
轴 平 移 a;， 绕 z 轴 旋转 角度 9， 沿 #3 轴 平移 d;， 可 实 
现 参考 坐标 系 i 相对 于 参考 坐标 系 i--1 的 定位 。 通 过 
这 些 独 立 变换 的 串联 ， 


Rot(x,_,, «,) Trans(x,_,, a,)Rot(z,, 0,)Trans(z,, d;), 


得 到 的 等 价 齐 次 变换 为 
cos6; — sing; 0 a; 
Sa «. sin@,cosa, cos@,cosa; —sina; — sina,d; 
sin@,;sing; cos@,sina; cosa; cosa, d; 


0 0 0 1 
| (1.42) 
上 述 几 何 参数 的 辨识 在 第 14 章 给 出 。 
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1.5 工作 空间 


通常 ， 机 器 人 操作 器 的 工作 空间 是 指 操作 器 执行 
所 有 可 能 的 运动 时 末端 扫 过 的 全 部 体积 ， 是 由 操作 器 
的 几何 形状 和 关节 运动 的 限 位 决定 的 。 特 别 地 ， 可 达 
空间 定义 为 末端 能 够 到 达 的 所 有 点 的 集合 ， 而 灵巧 空 
fg)! 为 末端 能 够 以 任意 姿态 到 达 的 所 有 点 的 集合 ， 
灵巧 空间 是 可 达 空 间 的 子 集 。 灵 巧 空间 仅 存 在 于 特定 
的 理想 几何 构 型 ， 真 正 的 工业 操作 器 带 有 关节 限 位 ， 
几乎 从 来 没有 灵巧 空间 。 

许多 串联 链 式 机 器 人 操作 器 是 如 此 设计 的 ， 其 关 
节 分 成 区 域 性 结构 和 方向 性 结构 。 区 域 性 结构 关节 实 
现 末 端 在 空间 中 的 位 置 定 位 ， 而 方向 性 结构 关节 实现 
未 刀 的 姿态 。 较 典型 地 ， 串 联 链 式 机 器 人 操作 器 的 内 
关节 由 区 域 性 结构 构成 ， 而 外 关节 由 方向 性 结构 构 
成 。 此 外 ,棱柱 式 关节 不 能 提供 旋转 能 力 ， 所 以 不 能 
用 于 方向 性 结构 。 

区 域 性 工作 空间 ， 可 由 串联 链 式 机 器 人 操作 器 的 
已 知 儿 何 构 型 和 关节 运动 限 位 计算 获得 。 在 由 区 域 性 
结构 构成 的 三 个 内 关节 中 ， 首 先 计 算 外 侧 的 两 个 关节 
(关节 2 和 3) 的 工作 空间 面积 ， 然 后 通过 对 剩余 的 
内 关节 〈( 关 广 1) 的 关节 变量 的 积分 ， 计 算出 区 域 性 
工作 空间 的 大 小 。 对 于 棱柱 式 关 节 ， 仅 需 将 面积 乘 以 
棱柱 式 关 节 的 运动 长 度 。 对 于 更 为 普遍 的 旋转 式 关 
T, 它 涉及 绕 关 和 轴线 的 全 范围 旋转 运动 的 面 
积 "”。 根 据 Pappus 定理 ， 相 关 的 空间 体积 为 

V=Ary (1.43) 
式 中 , A 是 面积 , 7 是 面积 的 质心 到 旋转 轴线 的 距离 ， 
y 是 该 面积 旋转 的 角度 。 该 面积 的 边界 通过 跟踪 末端 
一 个 参考 点 的 运动 确定 ， 较 典型 的 是 方向 性 结构 腕 部 
的 旋转 中 心 。 从 两 个 关节 的 运动 限 位 位 置 开始 ， 关 节 
2 RE, RT 3 一 直 运 动 到 其 第 二 个 限 位 位 置 。 然 
后 ， 关 节 3 BE, 关节 2 自由 运动 到 其 第 二 个 限 位 位 
Bo 关节 2 再 次 锁定 ， 关 节 3 自由 运动 到 其 初始 限 位 
位 置 。 最 后 ， 关 节 3 锁定 ， 关 节 2 自由 运动 到 其 初始 
限 位 位 置 。 在 这 种 方式 下 ， 参 考点 的 轨迹 是 一 条 封闭 
曲线 ， 其 面积 和 质心 可 以 通过 数学 方法 计算 出 来 。 
操作 器 空间 的 里 多 细节 参见 第 3 章 和 第 10 章 。 


16 正 向 运动 学 
串联 链 式 操作 器 的 正 向 运动 学 问题 ， 是 在 给 定 所 


有 关节 位 置 和 所 有 连 杆 几 何 参数 的 情况 下 ， 求 取 末 端 
相对 于 基 座 的 位 置 和 姿态 。 通 常 ， 固 定 于 末端 的 坐标 
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系 称 为 工具 坐标 系 ， 它 同时 固定 于 末端 连 杆 W E, 
在 位 置 与 姿态 上 通常 与 坐标 系 W 具有 固定 偏 移 。 类 
似 地 ， 一 个 固定 坐标 系 常设 置 于 基 座 上 ， 以 确定 被 执 
行 任务 的 位 置 。 该 坐标 系 在 位 姿 上 通常 相对 于 坐标 系 
0 具有 固定 偏 移 ， 坐 标 系 0 也 固定 于 基 座 上 。 

正 癌 运动 学 问题 的 更 一 般 性 描述 是 ， 给 定 操作 器 的 
几何 结构 ， 以 及 与 机 构 自 由 度数 量 相等 的 关节 数量 的 关 
TME, 求 取 任 意 两 个 指定 关节 之 间 的 相对 位 置 和 姿 
态 。 正 向 运动 学 对 于 开发 操作 器 坐标 算法 十 分 重要 ， 这 
龙 因 为 关节 位 置 常 由 安装 于 关节 的 传感器 测量 得 到 ， 而 
且 有 必要 计算 关节 轴 相 对 于 固定 参考 坐标 系 的 位 置 。 

实践 中 ， 正 向 运动 学 问题 通过 计算 两 个 坐标 系 之 
间 的 变换 来 求解 ， 一 个 是 固定 于 末端 的 参考 坐标 系 ， 
刃 一 个 是 固定 于 基 座 的 参考 坐标 系 ， 即 工具 坐标 系 和 
工作 站 坐标 系 。 对 于 串联 链 而 言 ， 该 变换 是 前 向 的 ， 
因为 描述 末端 相对 于 基 座 位 置 的 变换 是 从 链 路 中 国定 
于 相 邻 连 杆 坐标 系 之 间 的 变换 申 联 得 到 的 。1.4 节 给 
出 的 操作 器 几何 表示 的 约定 ， 将 上 述 变换 简化 为 求 取 
4 x4 的 等 价 齐 次 变换 矩阵 ， 该 矩阵 为 末端 坐标 系 相 
对 于 基 座 坐标 系 的 空间 偏 移 。 





以 图 1. 3 所 示 的 串联 链 式 操作 器 为 例 ， 忽 略 附加 

的 工具 和 工作 站 坐标 系 ， 其 变换 为 
Te =°T! T TTI TÉT, (1.44) 

表 1.8 PEAT, 的 各 个 元 素 ， 它 们 是 由 表 1.7 和 式 
(1.42) 计算 出 来 的 。 

再 次 说 明 ， 章 次 变换 提供 了 一 种 简洁 的 符号 ， 但 
在 求解 正 向 运动 学 问题 时 其 计算 效率 较 低 。 通 过 分 离 
变换 中 的 位 置 和 姿态 部 分 ， 删 除 矩 阵 中 所 有 的 与 0 和 
1 的 乘法 ， 可 以 降低 计算 量 。 在 第 2 章 ， 利 用 空间 矢 
量 符号 进行 计算 ， 这 些 符 号 在 1. 2. 6 节 中 进行 了 简要 
介绍 ， 详 细 解 释 见 2. 2 节 。 该 方法 不 需要 齐 次 变换 ， 
但 将 旋转 矩阵 和 位 置 分 离 以 提高 计算 效率 。 表 2. 1 给 
出 了 详细 的 公式 ， 特 别 是 与 正 向 运动 学 问题 相关 的 空 
间 变 换 的 积 。 

运动 树 是 不 含 闭 环 的 机 器 人 机 构 的 普遍 结构 ， 树 
结构 的 正 向 运动 学 在 第 2 章 给 出 。 由 于 附加 的 约束 ， 
闭 链 的 正 向 运动 学 问题 要 复杂 得 多 。 闭 链 的 求解 方法 
见 第 12 章 。 


表 1.8 图 1.3 串联 链 式 操作 器 的 正 向 运动 学 


Q_x 
rl 站 2 Th Ps 
avy 
0 rm Ta ra PG 
Ts = Ü z 
mi "a 733 P6 

0 0 0 1 


Fit = Ca (sg sg -caig ) (Sas — Cog Cos Co, ) -cp Sg Em (Cm Sey + spcn) + Sal ( Spa Cps C + Coq 395) 了 


Tor = $81 《sp2s0 — Cee ) (sp4s06 — Co4coscos ) ~ spl S05 Cg (CSa + sg2C03 ) — Ca (sp4Coscos + Cos0) ， 


T31 = (cp sp + spec) (se4sg6 — CaCa Cog, ) + Sos Cas (Sep sg — CoCo) 9 


F12 = Ca) (sg sg — cpcm) (Co Cos S46 + Sarg ) + Cay Sos Sop (Cen Spy + Sep Cg ) + Soy ( Coq Cp6 — Sax Cos Son, ) ; 


r22 = Ser (sos — Cm Ces) (CCo So + Spy Cos ) + S91 S5506 (Cos + Saca) — co (Co4cps — S005566 ) » 


732 = (cp sm + smCm ) ( C94 Cos 595 + Sole ) — Sas Sop ( Spy Spa lm lg ) 5 








M3 = Cg Coq S95 (Sep So -Epig ) 一 colco ( Cg Seq + Se Cg; ) — Ssg Smig ; 


一 一 © O 
Toa = Sq, Cases (SmS — Enee ) — $91 Ces ( Cap Soy + sg2cg3 ) + Coy SpaSgs ， 

— = > 
T33 = Casg (Coses +Spig) + gs (S53 -Cig ), 

Se 
°p =a3cgicg — daca (cosg + sgce), 

CO 人 CC 
od = 43591 Cg. — dasgl (Cg Soy +3memn), 

oC 


"PE = 一 se +da (sosa — Calg )- 


—_——ŘŘ—_ m 


TE: 缩写 cy = cosh; , sp = sing, 
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串联 链 式 操作 器 的 逆向 运动 学 问题 ， 是 在 给 定 末 
端 相 对 于 基 座 的 位 置 和 姿态 ， 以 及 所 有 连 杆 几何 参数 
的 情况 下 ， 求 取 所 有 关节 的 位 置 。 再 次 声明 ， 这 只 是 
对 串联 链 的 简单 描述 。 更 普遍 的 描述 为 : 给 定 一 个 机 
构 两 部 分 的 相对 位 置 和 姿态 ,求解 所 有 关节 位 置 的 
值 。 这 相当 于 给 定 感 兴趣 的 两 部 分 之 间 的 齐 次 变换 ， 
求 取 所 有 关节 的 位 置 。 

在 一 般 情况 下 ， 对 于 六 自由 度 串联 链 式 操作 器 ， 
已 知 变换 为 7。 重新 审视 1.6 节 中 该 变换 的 公式 ， 
可 以 发 现 串 联 链 式 操 作 器 的 逆向 运动 学 问题 需要 求解 
非 线性 方程 组 。 对 于 六 自由 度 操 作 器 ， 有 3 个 方程 与 
其 齐 次 矩阵 中 的 位 置 撩 量 有 关 ， 另 外 3 个 与 旋转 年 阵 
有 关 。 后 者 中 ， 由 于 旋转 矩阵 的 独立 性 问题 ， 这 3 个 
方程 不 能 来 自 相同 的 行 或 列 。 这 些 非 线性 方程 ， 可 能 
无 解 或 者 存在 多 解 “” 。 对 于 一 个 存在 的 解 ， 末 端的 
期 望 位 置 和 姿态 一 定位 于 操作 器 的 工作 空间 。 对 于 确 
实 存 在 解 的 情况 ， 这 些 解 常 常 不 能 表示 为 闭 式 解 ， 所 
以 需要 采用 数值 方法 。 


1.7.1 FAK 


由 于 闭 式 解 比 数值 解 速度 快 ， 而 且 容 易 区 分 所 有 
可 能 的 解 ， 所 以 希望 得 到 闭 式 解 。 闭 式 解 的 缺点 是 不 
通用 ， 依 赖 于 机 器 人 。 求 取 闭 式 解 的 最 有 效 方法 ， 是 
充分 利用 特定 机 构 几 何 特征 的 专门 技术 。 通 常 ， 对 于 
六 自由 度 机 器 人 ， 仅 带 有 特定 运动 结构 的 、 大 量 几 何 
参数 〈 在 1.4 节 定义 ) 为 0 的 机 器 人 ， 能 够 获得 闭 式 
解 。 大 部 分 工业 操作 器 具有 这 种 结构 ， 因 为 该 结构 允 
许 更 加 有 效 的 坐标 软件 。 六 自由 度 操作 器 具有 逆 运 动 
学 闭 式 解 的 充分 条 件 为 

1) 三 个 连续 的 旋转 式 关节 的 轴线 相交 于 一 点 ， 
如 球面 式 腕 部 。 

2) 三 个 连续 的 旋转 式 关节 的 轴线 平行 。 

闭 式 解 方法 可 分 为 代数 法 和 几何 法 。 

1. 代数 法 

代数 法 涉及 辨别 含有 关节 变量 的 有 效 方程 ， 并 将 
其 处 理 成 可 解 的 形式 。 一 种 常用 的 策略 是 简化 为 单 变 
量 的 超越 方程 ， 如 


C, cos; + Csin; + C} =0 
AH, Ci 、 C, AC, 是 常数 。 式 (1. 45 ) 的 解 为 


(1.45) 
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有 一 个 或 多 个 常数 为 0 的 特殊 情况 ， 也 较 常 见 。 
简化 为 具有 如 下 形式 的 一 对 方程 : 


" cosé, + C,sin@, + C, =0 


ð, = 2aetan| ) (1.46) 


(1.47) 
C sin; — C,cosé;, + C, =0 


是 另 一 种 特别 有 用 的 策略 ， 因 为 它 只 有 一 个 解 
8 = Atan2( ~- CC, —C,C,, C,C,-€,C,) (1.48) 


2. 几何 法 
几何 法 涉及 辨别 末端 上 的 点 ， 其 位 置 和 (或) 
姿态 可 以 表达 为 关节 变量 的 简约 集 的 函数 。 这 相对 于 
将 空间 问题 分 解 为 分 离 的 平面 问题 ， 形 成 的 方程 采用 
代数 方法 求解 。 上 述 的 六 自由 度 操作 器 闭 式 解 存在 的 
两 个 充分 条 件 ， 使 得 逆向 运动 学 问题 可 分 解 为 逆 问 位 
置 运 动 学 和 逆向 姿态 运动 学 。 这 也 是 1.5 节 讨 论 的 区 
域 性 结构 和 方向 性 结构 上 的 分 解 ， 重 写 式 (1.44) 
可 获得 其 解 ; 
"TÉT TET, ="T TT, (1.49) 
图 1.3 中 的 操作 器 具有 这 种 结构 ， 其 区 域 性 
结构 常 称 为 匀 链 式 或 人 形 臂 ,或 者 肘 式 操 作 囊 。 
这 种 结构 的 道 向 位 置 运 动 学 的 解 见 表 1.9。 由 于 9 
具有 两 个 解 ， 相 应 地 9, 和 0, 对 应 于 每 一 个 负 具 
Ai BA AE, FT A Be eR BR PE BS RI In) fi Bs a) 
学 共有 4 PS HE AS PS Be OY BR, 
相应 的 解 见 表 1.10。 表 1.10 中 给 出 了 6 的 两 个 
fz, 但 和 Ale, 对 应 于 每 一 个 6 只 有 一 个 解 。 因 
此 ， 球 式 手 腻 的 逆向 姿态 运动 学 具有 两 个 解 。 结 
合 区 域 性 结构 和 姿态 结构 ， 图 1.3 中 操作 器 的 道 
向 运动 学 解 共 有 8 个 。 
R19 图 1.3 串联 链 式 操作 器 中 的 贸 链 臂 的 
逆向 位 置 运动 学 


6, = Atan2 (°p ,°pz) 或 者 Atan2( -°p}, °p) 


6 = ~Atan2(D, + V1 _D*), EP, 


p- CAV + (pg)? + pe )* = 05 -då 
7 2a,d, 


0, = Atan2 (ps, VpE) + COP) 一 
Atan2(d, sing, » a3 + dcos, ) 
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表 1.10 图 1.3 串联 链 式 操作 器 中 的 球 式 手 腕 的 
逆向 姿态 运动 学 
| 


一 1 Z 
A; = Atan2 ( + 1 一 (riasg — r23 Cpt ) 971356) 一 macol ) 


6, = Atan2( F (7130p) + 143 Sg )$ (62 +63) + 133C( 92 +93) ? 





+ (riacg + Fogasa deem +63) F338 92 463) ) 








s = Atan2( + (Tiasa +799), + (711861 -raca ) ) 





TE: 缩写 cw =cosO;, sg = sind, 


17.2 数值 法 

不 同 于 求 取 闭 式 解 的 代数 法 和 几何 法 ， 数 值 法 不 
依赖 于 机 器 人 ， 故 可 用 于 任意 运动 学 结构 。 数 值 法 的 
缺点 是 速度 较 慢 ， 在 某 些 情况 下 不 能 计算 出 所 有 可 能 
的 解 。 对 于 一 个 仅 有 旋转 式 关节 和 棱柱 式 关节 的 六 自 
由 度 串 联 链 式 操作 器 ， 其 平移 和 旋转 方程 总 能 化 简 为 
单 变量 的 多 项 式 ， 其 阶 次 不 超过 16 By) | Be 
这 样 的 一 个 操作 器 的 逆向 运动 学 问题 有 16 个 实数 
解 …” 。 因 为 只 有 当 一 个 多 项 式 的 阶 次 不 超过 4 阶 时 
其 闭 式 解 是 可 能 得 到 的 ， 所 以 许多 操作 器 构 型 是 不 能 
获得 闭 式 解 的 。 通 常 ， 较 多 数量 的 非 零 几 何 参数 ， 对 
应 于 化 简 后 较 高 阶 次 的 多 项 式 。 对 于 这 样 的 操作 器 ， 
最 常用 的 数值 解 方法 分 为 符号 消 元 法 、 延 拓 法 和 迁 
代 法 。 

L 符号 消 元 法 

符号 消 元 法 涉及 从 非 线性 方程 系统 删除 变量 的 
解析 操作 ， 以 便 将 其 化 简 为 含有 较 少 方程 的 方程 组 。 
Raghavan 和 Roth”! 采用 析 配 消 元 法 ， 将 通用 六 自 
由 度 旋 转 式 串联 链 式 操作 器 的 逆向 运动 学 问题 化 简 
为 一 个 16 阶 多 项 式 ， 并 求 取 所 有 可 能 的 解 。 多 项 式 
的 根 提 供 的 是 其 中 一 个 关节 变量 的 解 ， 而 其 他 的 变 
量 通 过 求解 线性 系统 获得 。Manocha 和 Canny!!! iÑ 
过 将 该 问题 重新 形式 化 为 一 般 的 特征 值 问题 ， 改 进 
了 该 项 技术 的 数值 特性 。 另 一 种 消 元 方法 是 采用 
Grébner Flt 42] 5 

2. 延 拓 法 

延 拓 法 涉及 解 的 路 径 跟 踪 。 延 拓 法 从 具有 已 知 解 
的 起 始 系统 开始 ， 随 起 始 系统 到 目标 系统 的 变换 ， 跟 
踪 到 求解 的 目标 系统 。 这 些 技术 已 用 于 北向 运动 学 问 
题 …“: ， 其 多 项 式 系统 的 特殊 特性 可 用 于 求 取 所 有 可 
RER, 

3. 迭代 法 

许多 不 同 的 和 迭代 法 可 用 于 解决 道 向 运动 学 问题 。 
基于 初始 猜测 ， 大 部 分 迭代 法 能 够 收敛 于 一 个 单 解 。 


因此 ,初始 猜测 的 质量 对 求解 时 间 具 有 很 大 影响 。 
Newton- Raphson 法 提供 了 一 种 对 原始 方程 进行 一 阶 近 
似 的 基本 方法 。Pieper 上 "29 是 最 早 将 这 种 方法 用 于 逆 
问 运 动 学 的 人 之 一 ， 其 他 人 随后 +“'*%1。 优 化 方法 将 
逆向 运动 学 问题 形式 化 为 非 线 性 优化 问题 ， 并 采用 搜 
索 技术 从 初始 猜测 移动 到 解 。 求 解 运动 率 控制 将 上 述 
问题 转化 为 一 个 微分 方程 1， 而 且 一 种 修正 的 预 
济 一 一 矫正 算法 可 用 于 对 关节 速度 积分 ''”]。 基 于 控 
制 理论 的 方法 将 微分 方程 归于 控制 问题 51 。 间 隔 分 
析 '* ”或 许 是 最 有 前 途 的 迭代 方法 之 一 ， 因 为 它 可 以 
快速 收敛 到 一 个 解 ， 并 能 找到 所 有 的 可 能 解 。 对 于 复 
杂 机 构 ， 阻 尼 最 小 二 乘法 上 5 特别 具有 吸引 力 ， 更 多 
细 广 见 第 11 章 。 


1.8 正 向 微分 运动 学 


串联 链 式 操 作 器 的 正 向 微分 运动 学 问题 是 ; 给 
定 链 路 中 所 有 单元 的 位 置 和 所 有 关节 的 运动 速率 ， 
求解 末端 的 合 速度 。 此 处 的 关节 运动 速率 ， 是 绕 旋 
转 式 关节 旋转 的 角速度 ,或 者 沿 棱柱 关节 滑动 的 平 
移 速 度 。 单 元 的 合 速 度 是 固定 于 单元 的 参考 坐标 系 
原点 的 速度 与 单元 角速度 合成 的 。 换 言 之 , 合 速 度 
有 6 个 独立 分 量 ， 可 以 完全 代表 单元 的 速度 场 。 值 
得 注意 的 是 ， 该 定义 包含 了 如 下 假设 : 机 构 的 姿态 
是 完全 已 知 的 。 在 大 部 分 情况 下 ， 这 意味 着 在 处 理 
正 同 微 分 运动 学 之 前 ， 必 须 处 理 正 向 运动 学 问题 或 
者 逆向 运动 学 问题 。 在 下 节 中 讨论 的 道 向 微分 运动 
学 也 存在 同样 情况 。 当 为 了 研究 动力 学 而 进行 加 速 
度 分 析 时 ， 正 向 微分 运动 学 问题 是 重要 的 。 计 算 科 
ERAJ (Coriolis) 加 速度 和 向 心 加 速度 分 量 ， 需 要 
单元 的 合 速度 。 
正 同 运动 学 对 时 间 的 导数 ， 即 为 如 下 形式 的 方 
程 组 
vy =J(q)q (1. 50) 


AP, vy 是 末端 的 空间 速度 ，g 是 由 关节 速率 构成 
NERE, J) 是 6 xN 的 和 矩阵， 其 值 通常 是 
Gi, 0, dn 的 非 线 性 函数 。 J(q) 称 为 该 代数 系统 的 
雅 可 比 和 矩阵 ， 对 应 于 与 空间 速度 w 相同 的 坐标 
系 “” 。 如 果 关 节 位 置 已 知 ， 则 式 (1.50) 将 形成 6 
个 天书 速率 的 线性 代数 方程 。 如 果 给 定 关 节 速 率 ， 则 
A (1.50) 的 一 个 解 就 是 正 向 微分 运动 学 问题 的 一 
个 解 。 注 意 ， 所 有 关节 位 置 已 知 的 情况 下 ，J(q) 可 
以 认为 是 一 个 已 知 矩 阵 。 

利用 在 1. 2. 6 节 简 要 介绍 并 将 在 2. 2 节 详 细 解 释 
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的 空间 矢量 符号 ， 雅 可 比 矩 阵 可 很 容易 地 从 关节 的 目 
由 模 数 D, 和 相关 的 空间 变换 ' 夭 , 计算 出 来 。 与 关节 
速率 & 相关 的 J 了 (gq) 的 列 为 

XÈ, 
式 中 ,代表 vw 所 在 的 任意 坐标 系 。 在 本 手册 中 ， 
表 1.11 QR CARITAS RIK. K 
于 雅 可 比 和 矩阵 的 进一步 信息 参见 第 11 章 。 


表 1.11 从 关节 的 自由 模式 计算 雅 可 比 
和 矩阵 列 的 算法 


ni 关节 的 自由 度 的 数量 
‘yy =J(q) q ,天 是 任意 坐标 系 
J 的 与 9 相关 的 n, 列 


b, D 的 前 三 行 
P, 的 后 三 行 
Ji =*X,®, 
表达 式 计算 值 
XX, (RIR,; po + R2p') 


(R®,; R(®,-px@®,)) 


(R'; -Rp) 


(R'®@,; R'@,+pxR'®,) 


1.9 逆向 微分 运动 学 


从 机 器 人 坐标 的 观点 看 ， 逆 加 微分 运动 学 问题 是 
一 个 非常 重要 的 问题 。 关 于 机 器 人 坐标 的 更 多 信息 
见 第 5 章 和 第 6 章 。 串 联 链 式 操作 器 的 逆 品 微分 运 
动 学 问题 是 : 给 定 链 路 中 所 有 单元 的 位 置 和 末端 的 
AER, 求解 所 有 关节 的 运动 速率 。 当 控制 一 台 以 
点 对 点 模式 操作 的 工业 机 器 人 的 运动 时 ， 不 仅 需 要 
计算 与 期 望 的 手 爪 终点 位 置 对 应 的 终点 关节 位 置 ， 
而 且 需 要 在 起 点 和 终点 位 置 之 间 形成 光滑 的 运动 轨 
ws, MR, 会 有 无 限 多 的 可 能 轨迹 符合 此 要 求 。 但 
是 ， 最 直接 最 成 功 的 方法 采用 基于 逆 回 微分 运动 学 
问题 的 解 的 算法 。 该 项 技术 起 源 于 Whitney ™ 和 
Pieper! WTH. 

当 wx 已 知 时 ， 通 过 将 式 (1.50) 分 解 为 分 量 方 
程 ， 可 以 获得 由 含有 关节 速率 的 多 个 方程 构成 的 线性 
系统 。 为 了 求解 该 线性 系统 ， 有 必要 求 取 雅 可 比 矩 阵 
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的 逆 。 于 是 , A (1.50) 变 为 


q =J (gq)v, (1.51) 
HFJ 是 一 个 6 x6 KERE, PUA BA 
100Hz 及 以 上 的 速度 运行 的 实时 软件 中 ， 其 数值 逆 不 
是 很 有 上 吸引 力 。 更 糟 的 是 ,了 很 可 能 变 成 奇异 的 
(|J|=0)， 其 道 不 存在 。 关 于 奇异 性 的 进一步 信息 
参见 第 3 章 和 第 12 章 。 即 使 雅 可 比 矩 阵 不 是 奇异 的 ， 
它 也 可 能 是 病态 的 ， 导 致 在 操作 器 的 大 部 分 工作 空间 
中 性 能 退化 。 大 部 分 工业 机 器 人 的 构 型 比较 简单 ， 其 
雅 可 比 和 矩阵 可 以 解析 求 逆 ， 形 成 关 记 速率 的 显 式 方程 
ott 5658] ”与 数值 求 逆 相 比 ， 这 样 可 极 大 地 降低 计算 
量 。 对 于 更 加 复杂 的 操作 器 构 型 ， 数 值 求 道 是 唯一 的 
方法 。 宛 余 操 作 器 的 雅 可 比 矩 阵 不 是 方 阵 ， 所 以 不 能 
Kit, Hl 章 讨论 了 在 这 种 情况 下 如 何 应 用 各 种 
TA o 


1.10 静 力 变换 


操作 器 的 静 力 变 换 ， 建立 了 施加 于 末端 的 扭 秆 与 
施加 于 关节 的 力 / 力 矩 之 间 的 关系 。 这 对 于 控制 操作 
器 与 其 环境 的 交互 作用 是 十 分 重要 的 。 交 互 作用 的 例 
子 包括 涉及 固定 或 伪 固 定 工件 的 任务 ， 例 如 ，. 以 特定 
力 插件 ， 以 特定 力矩 拧紧 螺母 等 。 更 多 信息 见 第 7 章 
和 第 27 章 。 利 用 虚 功 原理 ， 施 加 于 末端 的 扭矩 与 施 
加 于 关节 的 力 / 力 矩 之 间 的 关系 可 表示 为 

t=J' f. (1.52) 


Ap, TIT n 自由 度 操作 器 关节 的 n 维 力 / 力 
ERE, f. 是 空间 力 天 基 


(1.53) 


AP, n ASAHI A A Ri, BY 
与 雅 可 比 矩 阵 位 于 同一 个 参考 坐标 系 。 因 此 ， 以 与 关 
节 速 率 映射 到 未 端 空间 速度 同样 的 方式 ， 雅 可 比 矩 阵 
将 施加 于 末端 的 扭矩 映射 到 施加 于 关节 的 力 /力矩 。 
在 速度 方式 下 ， 当 雅 可 比 矩 阵 不 是 方 阵 时 ， 其 道 关 系 
不 是 唯一 的 。 


1.11 结论 与 扩展 阅读 

本 章 简要 回顾 了 如 何 将 运动 学 的 基本 原理 应 用 于 
机 器 人 机 构 ， 内 容 涉及 空间 中 刚体 的 位 置 和 姿态 的 各 
种 表示 、 关 节 的 运动 自由 度 与 相应 数学 模型 、 描 述 机 
器 人 机 构 的 几何 表示 、 操 作 器 的 工作 空间 、 正 向 和 逆 
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1.1 


1.2 


1.3 


第 1 篇 机 器 人 学 基础 

CCC. 
门 运动 学 问题 、 正 向 和 北向 微分 运动 学 问题 (包括 雅 
可 比 和 矩阵 的 定义 ) 、 静 力 变换 。 当 然 ， 本 章 不 能 包 风 
和 运动 学 的 全 部 。 幸 运 的 是 ， 大 量 优秀 文献 对 重点 研究 
运动 学 的 机 器 人 学 提供 了 广泛 的 介绍 由 m2,2 ,20329691 
从 历史 上 看 ， 机 器 人 学 从 本 质 上 改变 了 机 构 运 动 学 领 
域 的 性 质 。 在 首次 出 现 关 于 机 器 人 的 坐标 方程 之 
BA) ， 机 构 领 域 的 焦点 几乎 全 部 集中 于 单 自 由 度 
机 构 。 这 就 是 为 什么 随 着 数字 计算 的 来 临 ， 机 器 人 学 
给 机 构 运 动 学 带 来 了 新 生 。 更 多 的 细节 见 第 3 Be E 
如 该 领域 从 工业 机 器 人 的 简单 串联 链 的 研究 (本 章 分 
析 的 重点 ) 中 扩展 开 来 一 样 ， 该 领域 还 在 继续 朝 着 不 
同方 向 发 展 ， 如 并 联机 器 〈 见 第 12 章 )、 仿 人 机 器 手 
(第 15 章 )、 机 器 人 运输 车 (第 16 章 和 第 17 章 ) ， 其 
至 小 型 机 器 人 (IÆ 18 章 ) 。 
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2.1 概述 


机 器 人 动力 学 提供 了 驱动 和 接触 力 之 间 的 关 
系 ， 以 及 带 来 的 加 速度 和 运动 轨迹 的 关系 。 运 动 
体 的 动力 学 方程 是 许多 算法 的 基础 ， 这 些 算法 可 
用 于 机 械 设计 、 控 制 及 仿真 模拟 。 目 前 增长 的 应 
用 领域 主要 是 移动 系统 的 计算 机 动画 ， 特 别 是 用 
于 人 体 及 人 型 模型 方面 。 本 章 将 提出 机 器 人 机 构 
的 基本 动力 学 关系 ， 以 及 最 常见 计算 的 有 效 算 法 。 
算法 将 采用 简洁 的 空间 矢量 记 法 一 一 种 6 维 的 天 
量 和 张 基 记 法 。 

本 章 针对 四 种 主要 的 计算 类 型 ， 提 出 相应 的 有 效 
低 阶 算法 : 

1) 道 向 动力 学 ， 即 通过 指定 的 机 器 人 轨迹 《位 
置 、 速 度 和 加 速度 )， 来 计算 关节 执行 器 的 力矩 / 力 。 

2) 正 向 动力 学 ， 即 用 指定 的 关节 执行 器 的 力 
矩 / 力 ， 来 确定 关节 加 速度 。 

3) 关节 空间 惯性 矩阵 ， 它 将 关节 加 速度 映射 到 
关节 力矩 / 力 。 

4) 操作 空间 惯性 矩阵 ， 它 在 操作 空间 〈 或 笛 卡 
儿 空 间 ) 上 ， 将 任务 加 速度 映射 到 任务 力 上 。 

逆向 动力 学 用 于 前 馈 控 制 ， 正 向 动力 学 则 用 于 模 
拟 仿 真 。 关 节 空 间 惯 性 〈 质 量 ) 和 矩阵 用 于 反馈 控制 
中 的 线性 化 动力 学 分 析 ， 同 时 也 是 正 向 动力 学 公式 的 
主要 部 分 。 操 作 空间 惯性 矩阵 主要 用 于 任务 控制 ， 或 
者 末端 执行 器 的 位 控制 。 


2.1.1 空间 矢量 记 法 


2.2 节 提 出 了 空间 矢量 记 法 ， 以 清楚 而 简练 的 方 
式 来 表示 本 章 的 算法 。 这 种 记 法 最 初 由 Featherstone 
fe?) ， 他 采用 6 维 的 矢量 和 张 量 形式 ， 用 简练 的 
矢量 记 法 来 描述 刚体 的 速度 、 加 速度 、 惯 性 等 。2. 2 
节 中 解释 了 空间 矢量 和 算 子 的 含义 ， 并 通过 表格 形 
式 ， 详 细 说 明了 6 维 空间 中 这 些 量 和 算 子 与 标准 三 维 
空间 的 对 应 关系 ， 以 便 后 面 章节 中 能 够 理解 这 些 算 
法 。 另 外 还 提供 了 能 有 效用 于 计算 实现 的 空间 算法 公 
式 。 作 者 力图 通过 空间 矢量 的 讨论 ,来 区 别 坐 标 天 量 
和 用 它 表 示 的 其 他 量 ， 并 阐述 空间 矢量 的 一 些 重 要 
特性 。 


2.1.2 正则 方程 


2.3 节 中 提出 了 运动 体 动力 学 方程 的 两 种 基本 形 
式 : 关节 空间 公式 和 操作 空间 公式 。 关 节 空 间 公 式 中 


的 各 项 一 般 通 过 拉 格 并 日 (Lagrangian) 方法 推导 ， 
其 不 依赖 于 任何 参考 坐标 系 。 拉 格 朗 日 公式 用 于 描述 
关节 执行 器 力 和 机 构 运 动 之 间 的 关系 ,以 及 系统 中 动 
能 和 势能 的 基本 关系 。 由 于 关节 空间 公式 具有 许多 市 
点 属性 ， 因 此 被 证 明 可 用 于 开发 控制 算法 。 此 外 ， 本 
节 还 提出 了 关节 空间 和 操作 空间 公式 中 相关 项 的 方 
程 ， 以 及 碰撞 模型 。 


2.1.3 刚体 系统 动力 学 模型 


本 章 中 的 算法 ， 需要 基于 这 样 一 种 数据 结构 模 
型 ， 它 能 通过 其 输入 参数 来 描述 机 器 人 机 构 运 动 。 
2.4 节 提 供 了 这 种 模型 的 分 量 描述 方式 : 连接 图 、 连 
杆 几 何 参数 、 连 杆 惯性 参数 ，. 以 及 一 组 关节 模型 。 连 
接 性 描述 具有 一 般 性 ， 以 便 能 够 涵盖 运动 树 和 闭环 机 
构 。 运 动 树 和 用 于 闭环 机 构 的 生成 树 共 用 通用 记 法 。 
为 了 描述 连 杆 和 关节 的 几何 学 ， 每 个 关节 上 和 采用 两 个 
关联 的 坐标 系 ， 分 别 放 在 前 时 村 和 后 继 杆 上。 后 继 坐 
标 系 可 定义 为 与 修正 Denavit Hartenberg 约定 兼 
07) ， 用 于 单 自 由 度 关节 。 前 导 坐 标 系 可 定义 为 一 
种 便捷 方式 ， 用 于 描述 一 般 的 多 目 由 度 关 节 。 采 用 
Roberson- Schwertassek 通用 关节 模型 来 描述 连 杆 间 的 
连接 关系 “”。 作 为 示例 ， 本 节 给 出 了 仿 人 机 器 人 的 
连 杆 和 关节 编号 方式 ， 以 及 用 于 描述 连 杆 和 关节 的 坐 
标 系 配置 。 该 示例 包括 浮 基 (底座 ) MARKT, 
万 向 节 和 球 关 节 。 


2.1.4 运动 树 


用 2.5 节 提 出 的 算法 ， 可 对 任意 机 器 人 机 构 〈 即 
运动 树 ) ， 计 算 道 向 动力 学 、 正 向 动力 学 、 关 节 空 间 
惯性 矩阵 和 操作 空间 惯性 和 矩阵。 对 于 逆向 动力 学 问题 
采用 0(n) 算法 ， 这 里 nn 为 机 构 中 的 自由 度数 。 它 利 
用 问题 的 牛顿 - 欧 拉 公式 ， 并 基于 非常 有 效 的 递归 牛 
顿 - 欧 拉 算法 (RNEA) 呈 4 和。 对 于 正 向 运动 学 问题 ， 
主要 采用 两 种 算法 : 一 种 是 Featherstone 提出 的 O(n) 
关节 体 算法 (ABA) Y, ah fhi Walker 和 Orin 
提出 的 O(n?) 复合 刚体 算法 (CRBA)?*!, AP 
算 关 节 空 间 惯 性 矩阵 (JSIM) 。 该 矩阵 连同 采用 
RNEA 得 到 的 矢量 ， 提 供 运 动 方程 的 系数 ， 用 于 对 加 
速度 的 直接 求解 中 。 操 作 空间 惯性 矩阵 (OSIM) 
为 一 类 关节 体 惯 量 ， 可 采用 如 下 两 种 算法 : 第 一 种 方 
法 是 采用 OSIM 的 基本 定义 ,第 二 种 方法 是 直接 的 
0(n) 算 法 ， 它 基于 正 向 运动 学 问题 的 有 效 解 。 为 方 
便 随时 查阅 ， 对 于 每 一 种 算法 的 输入 、 输 出 、 模 型 数 
据 及 伪 代 码 ， 都 总 结 在 表格 中 。 
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2.1.5 运动 环 

上 述 算法 仅 适 用 于 具有 运动 树 连接 性 、 无 分 支 
运动 链 的 机 构 。2. 6 节 给 出 了 最 终 的 算法 公式 ， 可 
用 于 闭环 系统 的 正 向 动力 学 ， 其 中 包括 并 联机 器 人 
机 构 。 该 算法 对 闭环 系统 的 生成 树 运用 动力 学 方程 ， 
并 补充 闭环 约束 方程 。 本 节 简 要 介绍 了 用 于 求解 线 
性 系统 的 三 种 方法 ， 其 中 方法 二 对 于 n>> mn 的 情况 
特别 有 用 ， 这 里 n* 为 闭环 关节 的 约束 数 。 该 方法 还 
提出 可 对 生成 树 运 用 O(n) 算法 中 。 在 本 节 最 后 ， 
提出 了 一 种 通过 将 变量 变换 到 单一 坐标 系 中 ， 来 计 
算 团 环 约束 的 有 效 算法 。 因 为 这 里 闭环 约束 方程 应 
用 在 加 速度 级 别 ， 所 以 采用 标准 Baumgarte 稳定 性 
RT 防止 闭环 约束 中 产生 位 置 和 速度 误差 
累积 。 

本 章 最 后 一 节 进 行 了 总 结 ， 提 出 了 延伸 阅读 
的 建议 。 机 器 人 动力 学 领域 已 经 并 将 持续 成 为 内 
容 丰 富 的 研究 领域 ， 本 节 概 述 了 本 领域 已 取得 的 
主要 成 果 ， 以 及 最 常 引述 的 相关 工作 。 由 于 篇 幅 
所 限 ， 不 能 全 方位 地 对 本 领域 内 的 众多 文献 加 以 
评述 。 


2.2 空间 矢量 记 法 


机 磊 人 运动 学 问题 的 描述 ， 目 前 还 没有 一 个 统一 
的 数学 记 法 。 当 前 使 用 的 包括 3 维 矢量 、4 x4 和 矩阵， 
以 及 几 种 类 型 的 6 ERE: 旋 量 、 对 偶 矢 量 、 李 代数 
元 素 和 空间 矢量 。 通 常 认为 6 维 矢量 记 法 最 好 ， 它 比 
3 维 矢量 记 法 紧凑 ， 又 比 4x4 和 矩阵 功能 强大 ， 因 此 
我 们 在 本 章 中 全 部 采用 6 维 矢量 记 法 ， 并 运用 参考 文 
献 [2.8] 中 提供 的 空间 矢量 代数 学 方法 。 此 外 ， 
4 x4 和 矩阵 介绍 见 参 考 文献 【2.9]， 其 他 6 维 矢量 参 
阅 参考 文献 [2. 10-12], 

在 本 书 中 ， 矢 量 通常 采用 粗 斜 体 字母 〈 如 : f、v )。 
然而 为 了 避免 命名 冲突 ， 我 们 将 采用 粗 正体 字母 表示 
空间 天 量 (W: f、v)。 注 意 这 种 表示 仅 适 用 于 矢量 ， 
而 不 用 于 张 量 。 同 样 ， 仅 在 本 节 中 ， 坐 标 矢 量 将 采用 
带 下 划 线 字母 ， 以 区 别 于 用 它们 表示 的 那些 矢量 
《如 坐标 2 、Y 表 示 w、v) 。 


2.2.1 运动 和 力 


出 于 数学 的 原因 ， 区 分 这 两 类 矢量 是 有 益 的 ， 
即 描述 刚体 运动 的 矢量 和 作用 于 刚体 上 的 力 矢量 。 
因此 我 们 将 运动 矢量 放 人 称 之 为 M5 的 矢量 空间 ， 
而 将 力 矢 量 置 人 了 空间 〈 这 里 上 标 表示 维 数 ) 。 运 


动 矢 量 用 于 描述 诸如 速度 、 加 速度 、 无 穷 小 位 移 ， 
以 及 运动 自由 的 方向 ， 力 矢量 描述 力 、 动 量 、 接 触 
法 线 等 。 


2.2.2 BEE 


Rv ARR, Av =(0,, n, v) EEJ 
坐标 天 量 ， 用 于 表示 在 正 交 基 |%, 9, 2) 中 的 v, 
则 vy 和 ww 之 间 的 关系 用 公式 表示 为 

v =KU, +70, +20, 

这 一 思想 也 适用 于 空间 矢量 ， 例 外 的 情况 是 采用 
Plicker 坐标 替代 笛 卡 儿 坐标 ， 并 用 Plucker 基 矢 量 替 
代 正 交 基 。 

Plücker 坐标 在 1.2.6 节 中 已 做 过 介绍 ， 基 矢量 
表示 如 图 2. 1 所 示 。 图 中 总 共有 12 个 基 矢 量 ; 6 个 
运动 天 量 和 6 个 力 矢量 。 给 定 的 一 个 笛 卡 儿 坐 标 系 
Oxyz, Plicker 基 矢 量 定义 如 下 : 3 个 关于 有 向 直线 
Ox. Oy, Oz 的 单位 转角 ， 表 示 为 don do. do; 
3 个 x、y、z 方 向 的 单位 平移 ， 表 示 为 和、 d,. d,; 
3 个 分 别 关 于 s, y, z 方向 的 单位 力 偶 ， 表 示 为 e 、 
e e; 3 个 沿 Ox, Oy, Oc 方向 的 单位 力 ， 表示 为 
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图 2.1 Plicker REE 
a) 运动 矢量 b) HEE 


22.3 空间 速度 和 力 


给 定 任意 一 点 0， 刚 体 的 速度 可 通过 一 对 三 维 矢 
量 w 和 vo 描述 ，w 和 vo 分 别 是 刚体 (构件) 上 当前 
位 于 0 点 的 一 个 固定 点 的 角速度 和 线 速度 。 注 意 v, 
DE O RAB HARTER, TERIA LIFES 0 点 重 
合 的 、 刚 体 固 定点 的 瞬时 速度 。 

对 同一 刚体 ， 其 速度 也 可 描述 为 一 个 空间 运动 矢 
量 ，veM 。 为 了 通过 o Av AA v, 我们 首先 介绍 
向 卡 儿 坐 标 系 Oxyz， 其 原点 为 0 点 。 此 构 型 对 ww 和 
yo 定义 了 向 卡 儿 坐 标 系 ， 也 对 v 定义 了 Plicker 坐标 
系 ， 给 定 这 些 坐 标 系 ， 可 以 表示 为 
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v=d,,@, +dooy +dow, + d,v9, + d vo, + 4,0, 
(2.1) 
这 里 wo. +, Uo, FET LAB ERR Oxyz P æ Fil vo BAB 
标 。 这 样 ，v 的 Pliicker 坐标 即 为 w Mvo Ht F JLE 
Pho TE Oxyz 中 用 坐标 矢量 表示 的 v 可 以 写成 : 


(2.2) 


式 中 最 右边 项 为 Pliicker 坐标 列 的 缩写 记 法 。 

类 似 地 可 以 定义 空间 力 : 给 定 任意 点 O， 作 用 在 
刚体 上 的 力 系 ， 可 等 效 为 沿 通过 0 点 作用 线 的 一 个 
集中 力 F， 再 加 上 一 个 纯 力 偶 ao， 它 是 力 系 关 于 O 点 
的 力矩 。 这 样 ， 用 两 个 矢量 了 和 mo 描述 作用 于 刚体 
上 的 力 系 ， 这 与 用 mw 和 vo 描述 速度 相 类 似 。 这 个 力 
也 可 用 一 个 空间 力 矢量 来 表述 ， 即 feF ， 引 人 与 前 
面 一 样 的 坐标 系 Oxyz， 可 得 

f=e,n,, + eno, + €,no, + ep. f, + ey Jy + Eo, f: 

(2.3) 
AP, nos ts LA Oxyz 中 的 了 和 mo 的 笛 卡 儿 坐 标 。 
在 Oxyz 中 用 坐标 矢量 表示 的 ff 为 


PH 


即 为 Oxyz P £ AY Plicker 坐标 ， 上 式 最 右边 的 项 为 
Pliicker 坐标 列 的 简化 记 法 。 


2.2.4 加 法 和 数 乘 


在 加 法 和 数 乘 中 ,空间 矢量 表现 为 显 式 方 式 。 例 
i, MAA ALBERT AIA, WENA 
fi +f。 叉 如 两 个 不 同 物体 分 别 具 有 速度 v Al y,, Jil 
第 二 个 刚体 相对 于 第 一 刚体 的 速度 为 vv -Yio WMR f 
表示 空间 上 1N 的 力 沿 着 某 一 直线 作用 ， 则 af 表示 
aN 的 力作 用 于 同一 直线 上 。 


2.2.5 数量 积 


数量 积 定 义 在 两 个 任意 的 空间 矢量 上 , 假设 其 中 一 
个 是 运动 ， 另 外 一 个 为 力 ， 给 定 任意 meM ,feF", 
数量 积 可 写成 m :上 或 者 fm 的 形式 。 这 表示 作用 
于 刚体 的 力 f 使 刚体 运动 m 所 做 的 功 , Bem + m 和 
f .了 的 表达 式 则 无 定义 。 如 果 mA f 为 同一 坐标 系 
下 ， 用 坐标 矢量 表示 的 mm 和 f， 则 有 


m:f=m'f 
2.2.6 坐标 变换 
运动 矢量 和 力 矢 量 服从 不 同 的 变换 规则 : 设 4 和 


(2.4) 


(2.5) 


B 为 两 个 坐标 构 型 ， 每 个 定义 一 个 同名 坐标 系 ; RS 
m,, ms, f,, fs 为 4 和 B 坐标 系 下 坐标 矢量 表示 
的 空间 矢量 ，m e Ms ,fe Fs ， 则 变换 规则 为 
ms = Xm (2.6) 
fo= "Xf, (2.7) 
式 中 ,“ 关 ,和 ”分 别 为 对 运动 和 力 和 失 量 从 4 到 8B 的 
坐标 变换 和 矩阵。 这 些 矩 阵 通 过 恒等式 相关 联 
"X =("X,) "=(“*X,)' (2.8) 
设 构 型 4 相对 于 构 型 B 的 位 置 和 姿态 通过 一 个 
位 置 矢量 "p 4 和 一 个 4 x4 的 旋转 矩阵 ”R，( 见 1.2 
节 ) 来 描述 ， WX, A 


1 0, ;°R, 0 
= (se ) 1) | R 
pa 0 R, (2.9) 


"R, 0 
7 (gesp yon, sp 


‘x Rs 0 l ° 2.10 
=| 0 r) ( scrp,) 1] a 
Sp) 为 斜 对 角 阵 ， 对 于 任意 的 3 AER By, W 

KES(p)v=p xv， 用 公式 表示 为 
0 -P P, 
S(p)=| e 0 -p, 
-P, P, 0 

2.2.7 矢量 积 

空间 矢量 的 矢量 积 (RA) 有 两 种 定义 ， 第 一 


种 是 由 两 个 运动 天 量变 量 得 到 一 个 运动 天 量 结果 ， 用 
公式 表示 为 


m; m, 
m, xm, = x 
Mig Mg 


m, Xm, 
- (n X Mo + Mio cm, 
第 二 种 是 运动 矢量 为 左 变量 ， 力 矢量 为 右 变量 ， 
其 积 的 结果 是 一 个 力 矢量 ， 即 


m fo mx fotmoxf 
sx 人 (人 -| (2. 13 ) 
~ \mp f mx f 


这 些 矢量 积 也 可 出 现在 微分 公式 中 。 
类 似 于 式 (2. 11) ， 也 可 定义 这 样 一 个 矢量 积 算 
子 ， 形 式 如 下 : 


(2. 12) 





(2. 14) 


S(m) 0 
S(m) -| 


S(m,) S(m) 
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在 这 种 情况 下 ， 
m, xm, =S(m, )m, (2. 15) 
而 
mxf=-S(m) f (2. 16) 
可 以 看 出 ， 这 里 S(m) 映射 运动 矢量 到 运动 矢 
i, Wi S(m)" 映射 力 矢量 到 力 矢 量 。 


2.2.8 微分 


空间 矢量 的 导数 定义 如 下 : 


d _ a S(x +6x%) — s(x) 
g>% = jim Bx 


AH, s 为 任意 空间 矢量 。 导 数 就 是 同类 空间 矢量 
(运动 或 力 ) 求 其 微分 。 

在 动 坐标 系 中 ， 对 空间 矢量 求 微分 的 公式 为 
(2.18) 


(2.17) 


(<5) = +Y, XS, 
RP, s 是 任意 空间 矢量 ; 学 表示 s 对 时 间 求 导 ; 


Aa, (T) 是 4 坐标 系 下 的 至 s, 是 s 在 


4 坐标 系 中 的 坐标 矢量 ; ds,/dt 是 s, 对 时 间 的 导数 
(这 里 对 各 分 量 求 导 ， 因 为 s 是 坐标 矢量 ); w 是 4 
坐标 系 下 的 速度 。 

对 于 运动 体 的 空间 矢量 ， 其 对 时 间 的 导数 是 变化 
的 ， 给 定 如 下 : 





devxs 
dt 


AH, vies 的 速度 量 。 此 公式 适用 于 自身 的 微分 量 
没有 变化 ， 而 它 附 在 运动 刚体 上 的 情况 〈 如 关节 轴 
天 量 )。 


2.2.9 加 速度 


空间 加 速度 定义 为 空间 速度 的 变化 率 。 然 而 这 里 
空间 加 速度 的 含义 不 同 于 传统 教科 书 上 的 刚体 加 速度 
定义 (我 们 称 之 为 经 典 加 速度 )， 其 本 质 差 别 概括 


如 下 : 
ww tw 
ee (2. 20) 


AF, a 是 空间 加 速度 ; a' 是 经 典 加 速度 ; yp 是 将 0 
点 固定 在 空间 上 时 对 ww 的 导数 ; of 是 将 0 点 固定 于 
构件 上 时 对 wo 的 导数 ， 两 种 加 速度 的 关系 为 


(2.19) 


(2.21) 


如 有 果 r EMERE, ERR 0 点 处 刚体 固定 点 相 
对 于 任意 空间 固定 点 的 位 置 ， 则 


(2. 22) 
vo = T -Xv 
两 种 加 速度 的 实际 差别 在 于 ， 空 间 加 速度 使 用 起 
来 更 方便 。 例如 :; 如 果 构 件 已 和 B, 分 别 具 有 速度 Vi 
A v, H Vw 是 B, 关 于 B, 的 相对 速度 ， 则 
VY, =V + VY 
其 空间 加 速度 间 的 关系 ， 只 要 对 上 述 速度 公式 求 
微分 即 可 得 到 
Ley, =V +Va) >a =a, +a,, 
di re re 
可 见 空间 加 速度 与 速度 类 似 ， 由 两 项 相 加 构成 ， 
不 用 考虑 科 氏 (Coriolis) 项 或 离心 项 ， 这 是 在 公式 
上 对 经 典 加 速度 的 一 个 重要 改进 ， 见 参考 文献 
[2.2, 13, 14], 
2.2.10 空间 动量 


设 刚体 质量 为 m， 质心 为 C， 旦 关于 C 点 的 转 
动 惯 量 为 I” (如 图 2.2 所 示 )。 如 果 构 件 运动 的 空 
闻 速 度 为 Ye = (w"vs)"， 则 其 线性 动量 为 h = moe, 
固有 角 动 量 为 hs。 = 1”"w。 它 关于 某 一 点 0 WEEE 
为 ho =hc +c xh， 这 里 c = 0C。 我 们 将 这 些 矢 量 组 
合成 一 个 空间 动量 矢量 的 形式 ， 表 示 如 下 : 


hey I" 
Mos 
h mvc 
H 
ho 1 S(e) 
bo =( | J={ 7 È (2.24) 
h 0 1 
空间 动量 为 力 矢量 及 其 相应 的 变换 。 
质量 :m 
转动 惯量 : 1 中 动量 
线 h=mu, 
j f he = Io 
0 空间 (e) 


图 2.2 空间 动量 


2.2.11 空间 惯量 


刚体 的 空间 动量 是 其 空间 惯量 和 速度 的 积 : 
h=1v (2. 25) 
这 里 了 是 空间 惯量 ,在 C 点 用 Pliicker 坐标 表示 ， 
可 得 


h; =[¢V- 


rm 0 
Mc -| 0 a) 
这 就 是 质心 处 刚体 空间 惯量 的 一 般 公式 。 而 对 男 
外 一 点 0 的 惯量 表达 式 ， 由 式 (2.21)、 式 (2.26) 
和 式 (2.27) ， 求 解 如 下 : 


(2.26) 
其 中 


(2.27) 


/1 Se) 
ho =| 1 


1 S(c) 
=(, 1 


m™ 0 


I r, Mi 
(e (se 由 


E 


ml 


_{ 1" +mS(e)S(e)™ mS(e) 
mS(c)" 
而 已 有 h, =15Vo 故 


I” +mS(c)S(c)" mS(c) 
I, = T T - (2.28) 
| mS(c)' ml | 
这 一 方程 也 可 写成 . 
I, mS(c) 
I, = - (2.29) 
[ase mi j 
其 中 
I, =I" +mS(c)S(c)" (2. 30) 


为 关于 点 0 的 刚体 转动 惯量 。 
空间 惯性 矩阵 为 对 称 正定 和 矩阵。 一 般 情况 下 ， 
确定 一 个 空间 惯量 需要 21 个 数 (如 : 对 于 关节 体 或 
者 操作 空间 惯量 ); 而 刚体 惯量 只 需要 10 个 参数 : 
质量 、 质 心 坐标 ， 以 及 7” (RI) 的 6 个 独立 
元 素 。 
空间 惯量 的 变换 规则 为 
. I, = “Xs TX, (2. 31) 
式 中 , 4 和 8B 为 任意 两 个 坐标 系 。 在 实际 运用 中 ， 经 常 
需要 只 给 定 已 ， 通 过 7 来 计算 1， 这 一 变换 的 公式 为 
I, = (°X,)°1;X, (2. 32) 
如 果 两 个 构件 ,分 别 具 有 惯量 I 和 7,， 将 其 刚性 
连接 成 一 个 复合 体 ， 则 复合 体 惯量 1 等 于 原来 各 部 
分 惯量 之 和 : 
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T= 十 也 (2. 33 ) 

这 个 简单 的 方程 代替 了 传统 三 维 矢量 方法 中 的 三 

个 方程 : 一 个 计算 组 合 质量 ， 一 个 计算 复合 质心 ， 一 

个 计算 复合 转动 惯量 。 如 果 刚 体 具有 惯量 1 并 以 速度 
Y 运动 ， 其 动能 为 


r= vi (2.34) 


如 果 刚 体 B 是 大 系统 的 一 部 分 ， 则 可 对 BEM 
一 个 表 观 惯性 矩阵 ， 用 于 描述 在 考虑 系统 中 其 他 构件 
的 影响 时 ， 作 用 于 B 上 的 为 与 加 速度 之 间 的 关系 ， 
这 个 量 称 作 关节 体 惯量 。 如 果 BOE SE BL a AR i 
执行 咒 ， 则 其 表 观 惯量 称 为 操作 空间 惯量 。 


运动 方程 
”空间 运动 方程 表明 ， 作 用 于 刚体 上 的 力 等 于 其 动 
量 的 变化 率 ; 


2.2.12 


d . 
= g =Ia+TIy 


可 以 证 明 ， 表 达 式 Iv 的 值 为 (v xI) an], 
故 运 动 方程 可 写 为 
f-Ia+vxIv (2. 35) 
这 一 单个 方程 合并 了 刚体 运动 的 牛顿 方程 和 欧 拉 
方程 。 为 了 验证 这 一 点 ， 我 们 复述 如 下 : 构件 质心 位 
置 表达 式 见 式 (2.35), 并 运用 式 (2.14)、 式 
(2.16) 及 式 (2.22)， 可 得 


ne Tem 0 w S(@)" Sve)" I" w 
J mad) Coo sen} bees 


2.2.13 计算 实现 


在 计算 机 上 实现 空间 矢量 算法 的 最 简单 方法 ， 就 
是 首先 利用 现 有 的 矩阵 运算 工具 ， 如 MATLAB® , 
并 按照 以 下 步骤 编写 程序 (或 从 网 上 下 载 ): 

1) 根据 式 (2.14), ict mK S(m), 

2) 根据 式 (2.9), WR Al pk X, 

3) 根据 式 (2.28), 通过 m、c MIR, 

其 他 空间 算 述 运算 ， 都 可 以 使 用 标准 的 矩阵 运算 
程序 ， 另 外 一 些 附加 程序 也 可 以 添加 到 列表 中 ， 如 : 
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1) 用 于 通过 各 种 其 他 转动 表示 式 ， EER W 
程序 。 
2) 用 于 空间 和 4 x4 和 矩阵 量 之 间 转 换 的 程序 。 
每 笑 考 虑 工作 效率 比 计算 效率 更 为 重要 时 ， 此 方 
法 便 值 得 推荐 。 

如 有 果 需 要 更 高 的 效率 ， 那 么 就 需要 使 用 一 个 更 精 
细 的 空间 运算 库 ， 包 括 : 

1) 对 每 类 空间 量 定义 专门 的 数据 结构 。 

2) 借助 效率 公式 ， 提 供 一 套 计 算 程 序 ， 每 个 程 
序 实 现 一 种 空间 算术 运算 。 

表 2. 1 中 列举 了 一 些 合适 的 数据 结构 和 有 效 的 计 
算 公 式 。 可 以 看 到 ， 用 于 刚体 惯量 和 Plicker 变换 的 
建议 数据 结构 ， 包 含 的 个 数 仅 为 6 x6 MEE ARS 
分 之 一 。 表 2. 1 中 列 出 的 效率 算法 公式 ， 比 通常 使 用 
的 6x6 和 6xl 和 矩阵 算法 计算 量 节 省 1.5 ~6 倍 。 更 
多 的 效率 公式 可 参阅 参考 文献 [2.16]. 


表 2.1 空间 矢量 记 法 









































空间 量 
y 刚体 速度 
a 刚体 的 空间 加 速度 (a= v) 
a’ 6 维 天 量 表示 的 刚体 经 典 加 速度 
f 作用 于 刚体 的 力 
1 刚体 惯量 
X 运动 矢量 的 Plücker 坐标 变换 
x? JIREH) Plücker 坐标 变换 (XF =X") 
"X, 从 4 坐标 到 如 坐标 的 Plicker 变换 
m 通用 运动 矢量 (M' 的 任意 元 素 ) 
3 4 
0 坐标 原点 
O 点 处 刚体 固定 点 ， 相 对 于 空间 任意 固定 
点 的 位 置 
w 刚体 角速度 
vo 0 点 处 刚体 固定 点 的 线 速度 (vo = F) 
w 刚体 角 加 速度 
to 0 点 固定 于 空间 上 时 ，vo 的 导数 
0 点 固定 于 刚体 上 时 ,v0 的 导数 ; 0 点 处 
“| 刚体 固定 点 的 经 典 加 速度 Cay = F) 
f 作用 于 刚体 的 力 ， 或 力 系 的 合力 
Ro FARA RX 0 SH 


m 刚体 质量 














( 续 ) 

c 刚体 质心 相对 于 0 点 的 位 置 

n AU PEKE h = me， 也 可 以 表示 为 线性 
动量 

re 关于 质心 的 转动 惯量 

I 关于 0 点 的 转动 惯量 

"R; 从 坐标 系 4 到 好 的 正 交 旋 转 矩 阵 变换 

Ap, B 坐标 系 原点 相对 于 4 坐标 系 原点 的 位 置 ， 
用 4 坐标 系 表示 

方程 





-| I s) 
S(h)" ml 


(SOS) rs) 
mS(e)" ml 








RI 0 BR, 0 
*RyS("p,)" PR, S("p,)°R, FR, 








v-f=f-v=vfau-n tof 
ee 


wxm S(@) 0 m 
vxm=( <m+axm,)*(S¢o,) sw) ) ( ) 


wxno tvg xf S( w) Svo) hy 
vVxf= = 
vos Co sca )(7) 





紧凑 计算 表示 法 
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( 续 ) 
有 效 空间 算术 公式 
表 达 式 it 算 值 
Xv (Rw; R(vo -P x) ) 
Xf (R(no -p xf); Rf) 
x7! (RT; -Rp) 

有 -ly (R'w; R'vo +p xR'o) 
CXF) -I (R'no +pxR' f; R" f) 
X, X, (R R3; P + R2p') 

I, +t, (ml +m; h, +h,; I, +1,) 
Iv (Ie +h xvo; Mvo —h xw) 
IK (m; R™h+mp; R™IR- 


S(p)S( Rh) —S(R*h + mp)S(p)) 


注 : XIX WEXLER (2.32), 


2. 2. 14 


空间 矢量 为 6 维 矢量 ， 它 合并 了 刚体 运动 的 线 度 
和 角度 两 个 方面 ， 这 使 得 紧凑 记 法 非常 适合 用 于 描述 
动力 学 算法 。 为 避免 名 称 上 的 冲突 ， 我 们 采用 粗 正体 
字母 表示 空间 矢量 ， 而 张 量 仍然 使 用 斜体 表示 。 在 接 
下 来 的 几 节 中 ， 将 采用 正体 字母 表示 空间 矢量 ， 以 及 
相 联 的 其 他 矢量 ， 如 q。 

表 2.1 简 要 列 出 了 本 闻 介 绍 的 各 种 空间 量 和 
算 子 ， 以 及 按照 3 维 量 和 算 子 定义 的 公式 。 本 节 
还 提出 了 数据 结构 和 效率 公式 ， 用 于 空间 算法 的 
计算 实现 。 此 表 结 合 表 1.5 和 表 1.6, 说 明 如 何 计 
算 各 种 关节 类 型 的 姿态 、 位 置 和 空间 速度 。 注 意 
在 读 取 表 2. 1 时 ,“R, 和 “ps 分 别 对 应 于 第 1 章 表 中 
HJIR, Ap; o 


人 小结 








2.3 正则 方程 


机 器 人 机 构 的 运动 方程 ， 通 常 表示 为 以 下 两 种 正 
MÉR: 
1) 天 空间 公 却 : 


H(q) q +C(q,q)q +T:(q) =T (2.37) 
2) 操作 空间 公式 : 
A(x) v tu(x,v) +p(x) =f (2.38) 


IÈ (2.37) 和 式 (2.38) 给 出 了 显 式 形式 的 函 
数 关 系 : Ae ga 的 函数 ; A 是 x 的 函数 等 。 一旦 明白 
了 这 些 关系 ， 表 述 时 就 可 以 省 略 。 在 式 (2.38) 中 ， 


x 为 操作 空间 坐标 中 的 矢量 ， 其 中 v 和 了 为 空间 矢量 ， 
分 别 表示 末端 执行 器 的 速度 和 作用 于 其 上 的 外 力 。 如 
果 机 絮 人 是 元 余 的 ， 则 这 些 方程 的 系数 必须 定义 为 q 


Al q 的 函数 ， 而 不 是 x 和 v 的 函数 。 

这 两 个 方程 连同 式 (2.37) 的 拉 格 朗 日 描述 ， 
以 及 碰撞 问题 的 运动 方程 ,在 下 面 会 作 进 一 步 
解释 。 


2.3.1 关节 空间 公式 


符号 q、q 、q 和 TT 分 别 表示 关节 的 位 置 、 速 
度 、 加 速度 和 力 变 量 的 n 维 矢量 ,这 里 是 机 器 人 
机 构 的 运动 自由 度数 ; 和 为 n xn 的 对 称 正 定 矩 
阵 ， 称 为 广义 (或 关节 空间 ) 惯性 矩阵 (JSTM ) ; 
C 是 nxn 和 矩阵 以 使 Cgq 为 科 氏 矢量 和 离心 项 ( 统 
称 为 速度 积 项 ); Ts 为 重力 项 的 矢量 。 如 果 需 要 考 
虑 其 他 动力 学 影响 〈 如 黏 性 摩 掠 ) ， 还 可 以 在 此 方 
程 中 加 进 更 多 项 。 在 末端 执行 器 上 ， 施 加 于 机 构 
的 作用 力 f 的 影响 ， 可 以 考虑 为 ,在 式 (2.37) 
的 右边 加 上 了 ff 项， 这 里 了 为 末端 执行 器 的 雅克 比 
矩阵 〈 见 1.8 节 )。 

q 为 机 构 构 型 空间 上 一 点 的 坐标 ， 如 果 机 构 为 一 
运动 树 〈( 见 2.4 节 )， 则 g 包含 机 构 中 的 每 一 个 关节 
变量 ， 和 否则 只 包含 其 中 独立 的 子 集 。g 的 元 素 为 广义 
坐标 ， 同 样 地 ，q 、9q 和 FT 的 元 素 分 别 为 广义 速度 、 
加 速度 和 力 。 


拉 格 朗 日 公式 


A (2.37) 中 各 项 的 推导 方法 很 多 ， 在 机 器 人 
学 中 最 常用 的 有 牛顿 - 欧 拉 公式 和 拉 格 朗 日 公式 。 前 
者 对 于 刚体 直接 用 牛顿 - 欧 拉 方 程 ， 它 包含 在 式 
(2.35) 的 空间 运动 方程 中 。 这 个 公式 特别 适合 开 
发 动力 学 计算 中 的 有 效 递 归 算 法 ， 见 2.5 节 和 
2.6 Ti. 

HRR BAA AOL as A OL aS BO eR dE 
行 计 算 : 


2.3.2 


L=T-U (2.39) 
式 中 ，7 了 和 也 分 别 为 机 构 总 的 动能 和 势能 。 动 能 由 下 
式 给 出 : 


1 


T= 4"H4 (2. 40) 


则 对 每 个 广义 坐标 ， 运 用 拉 格 朗 日 方程 ， 动 力学 方程 
可 展开 为 
d ob _ əl; 


(2. 41) 
di aq, ðq; 
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方程 结果 可 写成 标量 的 形式 : 


2 Hs q; + py S, Caii + Ts =T; (2.42) 
其 显示 为 速度 乘积 项 的 结构 ，C, 称 为 第 一 类 型 的 
Christoffel 符号 ， 给 定 如 下 . 
1 (oH, oH, aH, 
ih -| aq, 99; aq; 
其 仅 为 未 知 变量 g, 的 函数 , 式 (2.37) 中 CC 的 元 素 
定义 为 











(2. 43) 


C; = Cyd 
然而 这 里 对 C 的 定义 并 不 唯一 ， 还 有 其 他 可 能 的 定 
义 形式 。 
通过 式 (2.44) H C Hue, RAEN 可 给 定 
如 下 : 


(2.44) 


N(q,q) =H(q) -2C(q,q) (2. 45) 
ECR—P RMP? 7] En x1 HAE 
a 有 


a’ N(q,q)a=0 (2. 46) 
这 一 性 质 在 控制 中 非常 有 用 ， 特 别 是 当 a =q 时 ,有 


q'N(q,q)q =0 (2.47) 
由 能 量 守恒 定律 可 以 证 明 ， 对 于 任意 选 定 的 矩阵 
C, xt (2.47) a 


2.3.3 操作 空间 公式 


在 式 (2.38) 中 ,x 为 操作 空间 坐标 的 6 ER 
H, 它 给 出 了 机 器 人 末端 执行 器 的 位 置 和 姿态 ; y 是 
末端 执行 器 的 速度 ; f 为 外 加 的 力 。x 是 典型 的 竺 卡 
儿 坐 标 列表 ， 也 是 欧 拉 角 度 或 四 元 素 分 量 ， 生 与 v 有 
微分 关系 

x =E(x)v (2. 48) 
A 为 操作 空间 惯性 矩阵， 是 末端 执行 器 的 表 观 惯 
性 ， 它 考虑 到 了 机 器 人 机 构 其 余部 分 的 影响 〈 即 
它 为 关节 体 惯 性 ) ; u A p 分 别 为 速度 积 矢 量 和 重 
JIRE. 

操作 空间 (也 称 任务 空间 ) 中 ， 能 发 出 和 执行 
高 级 别 的 运动 和 力 指令 ， 因 此 其 公式 在 运动 和 力 控制 
中 特别 有 价值 ( 见 6.2 节 和 7.2 节 )。 式 (2.38) K 
了 用 于 6 维 空 间 外 ， 也 可 以 推广 到 操作 空间 中 ， 并 能 
应 用 到 一 个 以 上 的 末端 执行 器 的 组 合 运动 中 ”1。 

st (2.37) 和 式 (2.38) 中 的 项 和 下 列 公 式 
AX: 


v=Jq (2.49) 


v=Jq +Jq (2.50) 
T=J'f (2.51) 
A=(JH'J")7! (2. 52) 
pe =A(JH'Cq -J4q) (2. 53) 
p=AJH'T; (2.54) 


这 些 方程 都 假定 m&n (m 是 操作 空间 坐标 的 维 
数 ) ， 且 雅 可 比 矩 阵 J 为 满 秩 。 更 多 详情 参见 参考 文 
献 [2.20], 


MINEIRA 


如 果 机 器 人 运行 中 碰撞 了 外 界 刚 体 ， 那 么 接触 瞬 
间 产 生 冲 击 力 ， 就 会 引起 机 器 人 速度 的 阶 跃 变化 。 假 
设 末端 执行 器 和 外 界 刚 体 发 生 了 碰撞 ， 且 瞬间 冲击 力 
作用 在 末端 执行 器 上 ， 这 个 冲击 力 使 得 末端 执行 器 的 
速度 产生 了 Av 的 阶 茎 ， 两 者 通过 碰撞 运动 的 操作 空 
[i] Fy iS: 


2.3.4 


AAv =f (2. 55) 
在 关节 空间 中 ， 机 器 人 机 构 的 碰撞 方程 为 
HAq =T' (2. 56) 


AF, TA Ag 分 别 表示 关节 空间 中 的 冲 量 和 速度 恋 
化 。 在 涉及 机 器 人 未 端 执 行 器 的 碰撞 情况 下 ， 有 

T =JT (2. 57) 
及 

Av=JAq (2. 58) 
根据 式 (2.51) 和 式 (2.49), Mast (2.55) ~ 式 
(2.57) 中 可 得 到 


Aq =JAv (2. 59) 
Ae, 了 是 .的 惯性 加 权 伪 道 ， 给 定 如 下 : 
J=H'S'A (2. 60) 


J th Bip Ay TETT HAE BE BY Zh AS ASE M E peel?) 。 
注意 出 现在 式 (2.53) 和 式 (2.54) 中 的 表达 式 
AJH 7 J", BA H AA 均 为 对 称 阵 。 尽 管 文中 
我 们 是 在 碰撞 动力 学 问题 中 引入 的 J， 但 它 亦 可 用 于 
常规 〈 非 碰撞 ) 动力 学 方程 中 。 


2.4 刚体 系统 动力 学 模型 


机 器 人 机 构 的 基本 刚体 动力 学 模型 ， 由 四 部 分 组 
成 : 连接 图 、 连 杆 和 关节 几何 参数 、 连 杆 惯 性 参数 ， 
以 及 一 组 关节 模型 。 对 这 个 模型 ， 可 以 加 上 各 种 产生 
力 的 元 件 ， 如 弹簧 、 阻 尼 器 、 关 节 摩 擦 、 执 行 嚣 和 豫 
动 器 等 。 特 别 是 对 执行 器 和 驱动 器 ,其 具有 复杂 的 动 
力学 模型 。 在 关节 轴承 和 连 杆 上 ， 可 添加 额外 的 运动 
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自由 度 来 模拟 弹性 问题 (第 13 Bt), AW AGRA 
本 模型 关于 这 一 主题 的 更 多 内 容 ， 可 以 在 一 些 书 中 
找到 ， 见 参考 文献 (2.3, 8, 22]. 


2.4.1 连接 性 


连接 图 是 一 个 无 向 图 ， 其 中 每 个 节点 代表 一 个 刚 
体 ， 每 条 弧 线 表示 一 个 关节 。 该 图 必须 连接 ， 且 有 一 
个 节点 代表 固定 基 或 参照 系 。 如 果 图 表示 的 是 移动 机 
器 人 【〔 即 机 器 人 没有 连接 到 固定 基 上 )， 则 需要 在 固 
定 基 和 移动 机 器 人 任意 一 个 构件 间 ， 引 入 一 个 虚拟 的 
六 自由 度 关 节 ， 选 定 的 构件 称 为 浮 基 。 如 果 一 张 图 上 
表示 的 是 多 个 移动 机 器 人 的 集合 ， 则 每 个 机 器 人 都 有 
自己 的 浮 基 ， 每 个 浮 基 都 有 上 自己 的 六 自由 度 关 节 。 注 
意 这 里 的 六 自由 度 关 节 ， 没 有 在 两 个 连接 构件 间 施 加 
约束 ， 因 此 它 的 引入 只 是 改变 了 图 的 连接 性 ， 而 没有 
改变 系统 的 物理 属性 。 

在 图 论 术 语 中 ， 环 表示 一 个 与 自 映 节点 相连 的 
弧 ， 回 路 表示 一 条 闭合 路 径 且 不 能 穿越 任意 弧 一 次 以 
上 。 在 机 器 人 机 构 的 连接 图 中 ， 环 是 不 允许 的 ， 回 路 
称 为 运动 环 。 包含 运 动 环 的 机 构 称 为 闭环 机 构 ， 不 包 
含 运动 环 的 机 构 称 为 开 环 机 构 或 运动 树 。 每 个 闭环 机 
构 有 一 个 生成 树 ， 其 定义 为 开 环 机 构 ， 不 在 生成 树 上 
的 关节 称 为 闭环 关节 ， 树 上 的 关节 称 为 树 关 入 。 

固定 基 用 于 运动 树 的 根 节点 ， 也 是 闭环 机 构 任 
意 生 成 树 的 根 节点 。 如 果 至 少 一 个 市 点 具有 两 个 子 
PA, 运动 树 就 称 为 可 分 支 的 ， 否 则 称 为 不 可 分 支 
的 。 无 分 支 的 运动 树 称 为 运动 链 ， 有 分 文 的 运动 树 
称 为 分 支 运动 链 。 典 型 的 工业 机 器 人 手臂 ， 没 有 抓 
手 时 是 一 个 运动 链 ， 而 仿 人 机 器 人 是 带 有 浮 基 的 运 
动 树 。 

在 一 个 包含 Ns 个 运动 构件 和 Nj 个 关 订 的 系统 
中 ,这 里 入 包括 前 面 提 到 的 六 自由 度 关 节 。 运 动 构 
件 和 关节 编号 规则 如 下 : 首先 固定 基 的 编号 为 构件 
0(B0) ， 其 他 构件 按 一 定 次 序 从 1 到 Ns 编写 ,使 子 构 
件 编号 大 于 其 父 编号 。 如 果 系 统 包 含 运 动 环 ， 则 必须 
首先 选择 一 个 生成 树 ， 再 进行 编号 选择 ， 因 为 父 构 件 
的 识别 要 由 生成 树 确定 。 这 种 编号 风格 称 为 规则 编号 
方案 。 

完成 构件 的 编号 后 ， 就 要 对 树 关 节 从 1 到 Ns 进 
行 编 号 ， 以 便 通 过 关节 i 连接 构件 i 到 其 父 构件 上 。 
如 果 有 闭环 关节 ， 则 以 任 一 次 序 从 Ns +1 到 Nj 进行 
编号 。 每 个 闭环 关节 下 闭合 一 个 独立 运动 环 ， 环 编号 
从 1 到 NN, OXE N, =N; -N AAEM ABO, WR 
环 ! 由 关节 有 = ws +! 来 闭合 。 在 图 中 运动 环 1 是 唯一 
回路 ， 且 穿越 关节 大， 但 不 穿越 其 他 任何 闭环 关 贡 。 


对 于 无 分 文 的 运动 树 ， 这 些 规则 产生 唯一 的 编号 
方式 ， 构 件 的 编号 为 从 基底 到 顶部 进行 连续 单一 编 
号 ， 关 市 要 这 样 进行 编号 ; 关节 i 连接 构件 i 和 i -1。 
在 其 他 情况 下 ， 规 则 编号 均 不 唯一 。 

尽管 连接 图 是 无 向 的 ， 但 有 必要 对 每 个 关节 指派 
一 个 方向 ， 用 于 定义 关节 速度 和 力 ， 这 对 于 树 关 节 和 
闭环 关节 都 是 必需 的 。 具 体 地 讲 ， 关 节 用 于 连接 一 个 
构件 到 另 一 个 构件 ， 我们 可 以 将 关节 i 连接 的 两 个 构 
件 ， 分 别称 为 前 导 构 件 p(t) 和 后 继 构 件 s(i)， 则 关 
节 速 度 定义 为 后 继 件 相对 于 前 导 构 件 的 速度 ， 关 节 力 
定义 为 作用 于 后 继 构件 的 力 。 对 于 所 有 树 关 节 ， 标 准 
做 法 〈 但 非 必需 ) 是 从 父 构件 向 子 件 连接 。 

运动 树 或 者 闭环 机 构 生 成 树 的 连接 性 ， 可 通过 其 
父 构件 数 的 Ns 个 元 素数 组 来 描述 ， 其 中 第 i 个 元 素 
pli) 为 构件 i 的 父 构件 。 注 意 对 于 构件 i 的 父 构 件 
p(i) ， 也 是 关节 i 的 前 导 构 件 p(i) ， 因 而 是 通用 的 记 
法 。 许 多 算法 中 借助 p(i) < 的 特性 来 按 正确 次 序 完 
成 计算 。 对 于 子 构件 i:， 所 有 构件 编号 的 集合 c(i), 
也 在 许多 递归 算法 中 有 用 。 

对 于 运动 环 的 连接 性 数据 描述 ， 可 采用 多 种 
方式 。 能 方便 用 于 递归 算法 中 的 表述 ， 它 包括 如 
下 约定 : AAR k SHAE p(k) 和 后 继 构 件 
s(k) HE, EA LRG) 为 构件 i 的 环 编号 ， 这 里 
构件 i 为 根 环 。 在 生成 树 中 对 构件 运用 p(i) <i 特 
性 ， 根 环 选 为 具有 最 小 编号 的 构件 ， 同 时 构件 i 的 
集合 LB(i) 给 出 了 环 的 编号 ,构件 i 属于 环 但 不 
是 根 。 

图 2.3 给 出 了 闭环 系统 的 一 个 例子 ， 该 系统 由 带 
有 拓扑 变 接点 的 人 形 机 器 人 机 构 组 成 ,分别 与 外 界 及 
内 部 机 构 相 连 ， 形 成 闭环 。 系 统 有 Ne = 16 个 运动 构 
件 ( 连 杆 ) MN =19 FAW, URN, =N; -Ng =3 
个 环 。 主 构件 (1) 作为 移动 机 器 人 系统 的 浮 基 ， 其 
与 固定 基 (0) 通过 一 个 假定 的 六 自由 度 关 节 (1) 
相连 。 为 完成 本 例 ， 对 一 个 环 的 闭环 关节 、 构 件数 
p(k) 和 s(k)， 以 及 根 构件 等 都 通过 表 2.2 给 出 ， 基 
于 构件 的 集合 c(i) 和 ZLR(i) 在 表 2.3 中 给 出 。 注 意 
本 例 中 LR(0) = 11,，3}、LA(1) ={2}, ARK LR 
均 为 零 。 


2.4.2 连 杆 几何 


当 两 个 构件 〈 连 杆 ) 通过 关节 连接 ,该 连接 的 
完整 性 描述 由 关节 本 身 以 及 两 个 坐标 系 的 定位 来 表 
述 ， 每 个 构件 上 有 一 个 坐标 系 ， 指 出 关节 定位 在 构件 
的 什么 地 方 。 如 果 系 统 中 有 以 个 关节 ， 则 总 共有 2N, 
个 附属 的 关节 坐标 系 。 其 中 一 半 的 坐标 系 采用 1 ~N, 
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注 : 图 中 为 了 区 分 构件 编号 和 关节 编号 ， 在 构件 
编号 前 面 加 上 字母 “B” 


表 2.2 人 形 机 器 人 算 例 中 的 闭环 关节 及 根 环 
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进行 编号 ， 其 余 的 标示 为 JI ~ IN, REPRE i AB 
标 系 到 坐标 系 i 进行 连接 ， 对 于 关节 1 ~ N，( 即 树 
关节 )， 坐 标 系 守 刚性 放置 于 构件 ; 上。 对 于 关节 
Ns +1 到 N,， 用 于 闭环 关节 的 坐标 系 k， 将 刚性 放 
BTA s(k) 上 。 对 每 个 关节 i， 无 论 是 树 关节 还 
是 闭环 关节 ,第 二 个 坐标 系 Ji 放置 在 前 导 构 件 pli) 
E. BRR 五 为 关节 无 提供 基 坐 标 ， 相 对 于 此 坐标 
系 定义 关节 的 平 动 和 转动 。 

图 2. 4 显示 的 是 系统 中 的 坐标 系 ， 以 及 与 每 个 关 
TARRE., MFR, MERA pli) 到 
坐标 系 i 的 坐标 变换 给 定 如 下 : 

Ky = KK, =X, (i) X, G) (2. 61) 
AF, ERER X, (i) 为 固定 的 连 杆 变换 ， 它 设 定 
为 关节 了 的 基 坐 标 Ji, XIIF p(i) 的 变换 ， 可 用 于 
将 空间 运动 矢量 从 p(i) 变换 到 Ji AAR; XG) 为 一 
可 变 的 关节 变换 矩阵 ， 其 用 于 完成 关节 从 坐标 Ji 2 
i 的 坐标 变换 。 





a) b) 


图 2.4 坐标 构 型 和 变换 
a) HE b) 闭环 关节 


类 似 的 ， 对 于 闭环 关节 ， 从 坐标 系 p(k) 到 坐标 
系 上 的 坐标 变换 如 下 : 
Ko = Kp Ko =X (k)Xy(k) (2.62) 
附加 变换 Xok) 定义 为 从 坐标 系 s(k) 到 坐标 
系 上 的 坐标 变换 ， 其 表示 如 下 : 
Xn (k) = 于， (2. 63) 
连 杆 和 关 蔬 数据 可 以 通过 多 种 途径 来 指定 ， 最 常 
用 的 方法 是 使 用 D-H ( Denavit- Hartenberg ) 参 
数 “” 。 然 而 标准 的 D-H 参数 不 完全 具有 通用 性 ， 
不 足以 对 几何 特性 进行 完整 描述 ， 如 有 分 支 的 运动 
树 。 或 者 包含 有 某 些 多 自由 度 关节 类 型 的 机 构 。 本 书 
中 采用 了 修正 形式 的 D-H BR?) FAFA HEX 
节 《( 见 1.4 节 )。 这 些 参 数 已 扩展 到 有 分 支 的 运动 树 
及 闭环 机 构 上 。 


2.4.3 连 杆 惯量 
连 杆 惯量 数据 包括 机 构 中 各 连 杆 的 质量 、 质 心 位 


置 和 转 到 惯量 。 在 坐标 系 i 中 ， 连 杆 i 的 惯性 参数 表 
达 式 为 常数 。 


2.4.4 关节 模型 


两 个 连 杆 之 间 的 连接 关系 ， 常 采用 Roberson- 
Schwertassek (R-S) 广义 关节 模型 描述 *。 对 于 运动 
树 或 者 闭环 机 构 上 的 生成 树 ，n, xl 的 矢量 9 ;表示 连 杆 ; 
相对 于 其 父 构件 pCi) 的 速度 ， 其 中 恬 为 连接 两 个 连 杆 
的 关节 的 自由 度数 。 对 于 闭环 机 构 的 闭环 关节 ， 为 连 杆 
s(i) (后 继 杆 ) 和 连 杆 p(i) (前 导 杆 ) 之 间 的 速度 关 
系 ， 在 其 他 情况 下 为 坐标 系 i 和 五 间 的 速度 关系 。 

令 Ya 和 aw 为 穿 过 关节 二 的 速度 和 加 速度 ， 即 
s(i) 相对 于 p(i) 的 速度 和 加 速度 。 关 节 的 自由 模式 
用 6 xn; 的 矩阵 中 表示， 这 样 vy 和 a 表示 如 下 : 

Va = @. 4; (2. 64) 
a = Dd,+D,q, (2. 65) 
AF, DA PRATAP, BE 更 为 列 满 
秩 ， 故 可 定义 一 个 互补 矩阵 Ø, MUEG x6 的 矩阵 
(DD) 为 可 逆 和 矩阵 ， 我 们 可 将 这 个 矩阵 的 列 看 成 
M' 上 的 基 ， 以 便 将 第 一 个 n; 基 矢量 (矩阵 第 一 列 ) 
定义 为 运动 的 允许 方向 ， 且 其 余 的 6 -n = 让 个 矢量 
KE LABIA SUV lo KEE, DP RAR i WA 
束 模式 。 

KA i, MAAST Rae, a 
EUTF: 


ET (2.66) 


AP, TARA MRA n x 1 PAAR; AÑ 
(6-n,) x1 的 约束 力 和 失 量 ; pA bist Fore: 
(hit) = (BB?) (2. 67) 
对 于 大 多 数 常 见 的 关节 类 型 ， 可 通过 选择 D, Al 
D, IERE (PD) SUA LIER, MME (pi) 
EREL (DD) 相等 。 注 意 式 (2.67) 含有 如 
下 关系 : (yi) P, = Linn, (p) Be = 0, .6-。)， 
(WE) D: =O 66 ny xni (of) hi = Leen) x62) © 当 将 
其 应 用 于 式 (2.66) 时 ， 可 得 如 下 结果 : 


T; =@'f, (2. 68 ) 


st (2.65) 中 瑟 , 的 值 取决 于 关节 类 型 ， 其 一 般 
公式 为 


D, = P, +y, xÒ, 
sth, v, 是 连 杆 i 的 速度 ; O E OKREA, B 


(2.69) 
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观察 者 随 连 杆 ;一 起 运动 时 所 看 到 的 ， 萝 ;给 定 如 下 
(2. 70 ) 


对 大 多 数 常 见 关节 类 型 ，®$, =0。 

采用 D-H 约定 时 ， 对 单 自由 度 关节 (n, =1) 就 特 
别 简单 ， 运 动 选 择 为 沿 z, 轴 横向 平移 或 绕 z. 轴 轴 向 旋转 。 
在 这 种 情况 下 ， 对 于 平移 关节 ,= (000001) ,对 旋 
转 关节 o, =(001000)", 同样 ,=0。 

对 于 移动 机 器 人 浮 基 的 虚拟 六 自由 度 关 节 来 说 ， 
也 很 容易 作 相 关 的 处 理 ， 这 种 情形 下 更 =1 (6x6 


的 单位 矩阵 ) ， 且 更 , =0。 

旋转 关节 和 浮 基 关节 ， 以 及 万 向 关节 (n =2) 
和 球 关节 (n, =3)， 在 下 一 节 中 将 进行 举例 说 明 。 更 
多 关节 运动 学 的 问题 ， 详 见 1.3 节 。 


2.4.5 系统 算 例 


为 说 明 连 杆 及 关节 模型 的 规则 约定 ， 人 形 机 器 人 
的 坐标 系 分 别 放 在 前 五 根 连 杆 《〈 构 件 ) 和 固定 基 上 ， 
如 图 2. 5 所 示 。 注 意 对 5 个 关节 ， 每 个 关节 的 坐标 系 
Ji WEER pG) =i -1 E, AAP JI 的 坐标 原点 放 
在 与 坐标 系 0 的 原点 重合 位 置 ， 且 坐标 系 J2, B, 
J4. JS 的 坐标 原点 分 别 与 坐标 系 2、3、4、5 的 原点 
ES. FEJ 可 以 设置 为 固定 基 (BO) 上 的 任意 位 
置 /姿态 ， 以 方便 表示 浮 基 (Bl1) 相对 于 固定 基 的 运 
动 ， 同 样 且 的 原点 也 可 以 设 在 沿 2 的 任意 位 置 。 

表 2.4 中 给 出 了 本 例 中 每 个 关节 的 目 由 度数 、 基 
坐标 系 Ji 的 国定 旋转 和 人 位置。 旋转 矩阵 ' R o 
p(t) 坐标 系 中 的 3 维 矢量 变换 到 i DAP, We 
ME p, ARA 0 相对 于 O 的 位 置 , 用 p(i) 坐 
标 系 表示 的 矢量 。 空间 变换 和 矩阵 X, (i) =" X ye 
过 表 2. 1 中 的 3 维 量 对 "X 变换 构成 。 人 形 机 构 具 有 
FE, KT. IRA ER (EF 纪 )、 
WREED, ERIEK, LAR RRR AL TS i 
关节 。 如 图 2. 5 Bray, GPRS, Ah ea Cae 
部 2 方向 有 大 约 90?" 的 旋转 ) 。 

人 形 机 器 人 中 ， 对 于 所 有 关节 类 型 的 自由 模式 、 
速度 变量 ， 以 及 位 置 变 量 均 在 表 1.5 和 表 1.6 中 给 
出 。 通 过 关节 变换 关系 X (i) ='X,, KARP 
的 R, 和 和 ip, 分 别 给 出 /Rj 和 pi; 的 表达 式 。 旋 转 关 节 关 于 
z. 轴 的 旋转 遵循 D-H 约定 ， 紧 随 关于 MM Roe 
转角 B, ， 躁 关节 有 关于 2 轴 的 俯仰 旋转 角 as (WR 
1.1 中 的 Z-Y 了 -外 欧 拉 角 定义 )。 授 关节 模拟 成 球 帘 
状 的 球 贸 。 为 避免 与 欧 拉 角 产生 关联 奇异 性 ， 可 用 四 
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图 2.5 人 形 机 器 人 示例 中 前 5 个 构件 和 关节 的 
坐标 系 示 意图 


表 2.4 系统 算 例 中 ， 关 节 自 由 度数 、 
旋转 矩阵 和 位 置 矩 阵 








机 器 人 学 基础 


TOR ©; FAN AB AS, TCR E 和 相对 转动 率 
O: NRRER BY 1.7 节 已 给 出 。 

浮 基 采 用 躯干 p; 的 位 置 和 四 元 素 e ,分 别 作 为 其 
位 置 和 姿态 变量 。 艇 于 的 位 置 可 通过 对 连 杆 的 速度 进 
行 积分 来 计算 ， 在 固定 基 坐 标 中 表示 为 :"w =Rv, 
其 中 ， 为 动 坐标 系 中 躯干 的 速度 。 


注意 这 里 除了 万 向 节 外 ， 对 于 其 他 关节 有 $, =0。 


因为 连 杆 5 坐标 上 2 的 分 量 随 Bs 变 化 ， 故 名, 关 0。 更 
详尽 的 关节 运动 学 见 本 书 的 1.3 节 。 


2.5 运动 树 


与 闭环 机 构 的 动力 学 相 比 ， 运 动 树 的 动力 学 要 简 
单 并 易于 计算 一 些 。 闭 环 机 构 的 许多 算法 首先 要 计算 
生成 树 的 动力 学 ， 然 后 再 加 上 闭环 约束 。 

本 节 讲 述 运动 树 的 如 下 动力 学 算法 : 逆向 动力 学 
的 递归 牛顿 - 欧 拉 算法 (RNEA)、 正 向 动力 学 的 关节 
体 算 法 〈ABA) 、 计 算 关节 惯性 矩阵 〈JSIM) 的 复合 
刚体 算法 (CRBA)， 以 及 用 于 计算 操作 空间 惯性 矩 
Fe (OSIM) 的 两 种 算法 。 


2.5.1 递归 牛顿 - 欧 拉 算 法 


这 是 一 种 计算 复杂 度 为 0(n) 的 算法 ， 用 于 
计算 固定 基 运 动 树 的 逆向 动力 学 , 它 是 基于 Luh 
等 人 的 一 种 非常 高 效 的 牛顿 - 欧 拉 算 法 
(RNEA)“””。 另 外 有 关 浮 基 的 算法 可 在 参考 文献 
[2.8, 15] 中 找到 。 给 出 关节 的 位 置 和 速度 变量 ， 
该 算法 计算 应 用 关节 力矩 / 力 变 景 时 ,需要 给 定 一 
组 关节 加 速度 。 

首先 ， 连 杆 的 速度 和 加 速度 可 通过 向 外 递归 计算 
出 来 ， 即 从 固定 基 向 树 的 叶 链 ERR) 方向 递归 。 
在 递归 过 程 中 ,采用 牛顿 - 欧 拉 方程 式 (2.35), H 
算出 每 个 连 杆 上 的 合力 。 其 次 ， 向 内 递归 采用 每 个 连 
杆 上 的 力 平衡 方程 来 计算 经 过 每 个 关节 的 空间 力 ， 以 
及 每 个 关节 力矩 / 力 变 量 的 值 。 影 响 计算 效率 的 关键 
步骤 在 于 如 何 把 最 多 的 量 纳入 到 连 杆 局 部 坐标 中 。 同 
样 ， 机 构 向 上 加 速 时 ， 每 个 连 杆 上 的 重力 影响 也 应 包 
括 在 方程 中 。 

计算 过 程 分 为 如 下 4 步 ， 其 中 两 步 中 ， 每 步 有 两 
次 递归 。 

1) 第 一 步 。 从 国定 基 的 已 知 速度 和 加 速度 开 
始 ， 依 次 计算 每 个 连 杆 的 速度 和 加 速度 ， 并 朝 树 顶 方 
向 进行 ， 即 连接 图 中 的 时 节点 方向 。 

运动 树 上 每 个 连 杆 的 速度 由 递归 公式 给 出 
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Vi = Vo +@.q,, (v=0) (2.71) 4) 第 四 步 。 计 算 关 节 力 变量 T;。 由 定义 得 
式 中 ,vj 为 连 杆 i 的 速度 ; @ ATi Hie, T= (2.75) 


9 ;为 关节 ;的 关节 速度 变量 的 天 量 。 

加 速度 的 等 效 换算 公式 可 通过 对 式 (2.71) 求 

微分 得 到 

a; = a, + 中， g, +0,4., (a, =0) (2. 72) 
式 中 ，a; 为 连 杆 i 的 加 速度 ; 4; 为 关节 加 速度 变量 的 
天 量 。 

机 构 上 均匀 重力 场 的 影响 ， 可 通过 将 am 中 的 零 
初始 化 为 - a, 来 模拟 实现 ， 这 里 a, 为 重力 加 速度 和 天 
量 。 在 这 种 情况 下 ，ai 不 是 连 杆 的 真实 加 速度 ， 而 是 
真实 加 速度 与 -as 的 和 。 

2) 第 二 步 。 计 算 每 个 连 杆 的 运动 方程 。 这 一 步 
计算 力 时 需要 用 到 上 一 步 计 算得 到 的 加 速度 。 连 杆 ; 
的 运动 方程 为 

f° =a; +v; x,y, (2.73) 
AP, 1 为 连 杆 的 空间 惯量 ; PP AE AF i 
的 力 。 

3) 第 三 步 。 计 算 通过 每 个 关节 的 空间 力 。 参 照 

图 2.6， 作 用 于 连 杆 i 上 的 力 为 


式 中 ,为 通过 关节 i 的 力 ; 人 为 作用 于 连 杆 i 上 的 所 
有 相关 外 力 之 和 ; c(i) 为 连 杆 i 的 子 集 。 重 新 整理 
方程 ， 得 到 计算 关节 力 系 的 递归 公式 如 下 : 


f, =f) -f+ Dif, 


jeeli) 


(2.74) 
式 中 , i 从 Ns 到 1 迭代。 







c(i) = {C1, C2, soe Cm? 


关节 i 
， 图 2.6 作用 于 连 杆 i 的 力 系 


人 可 能 包括 这 些 因素 的 贡献 ， 如 弹簧 、 阻 尼 僚 、 
力 场 、 外 界 接 触 等 ， 但 其 值 应 假设 已 知 ， 或 至 少 可 通 
过 已 知 量 计算 出 来 。 如 果 重 力 还 未 通过 虚拟 基 的 加 速 
度 模拟 ， 则 作用 于 连 杆 i 的 重力 项 必须 纳入 到 个 中 。 


1. 无 坐标 (Coordinate- Free) 算法 
表 2.5 表示 的 是 式 (2.71) ~ 式 (2.75) 所 包括 

的 算法 ， 它 是 牛顿 - 欧 拉 算法 (RNEA) 的 无 坐标 形 

式 。 这 是 该 算法 的 最 简单 形式 ， 适 合 于 数学 分 析 及 相 

关 用 途 ， 但 不 适合 用 于 数值 计算 ， 因 为 数值 形式 的 算 

法 必须 采用 坐标 矢量 。 

表 2.5 用 于 逆向 动 力学 的 无 坐标 递归 牛顿 - 欧 拉 算法 
Vo =O 
ao = 一 ae 

for :=1 to Np do 

Vi = YG) +@.4; 

a; =a, i) + D; 9; +@.q; 

f, =La; +v; X1,v; 一 下 
end 

for i= Np to 1 do 

T; = @;'f, 
if p(i) #0 then 
fii =Ë 


oi) tf; 
end 


end 





2. 连 杆 坐标 算法 

一 般 情 况 下 ， 如 果 对 每 个 连 杆 定义 一 个 坐标 系 ， 
我 们 所 说 的 算法 就 在 连 杆 坐标 系 中 实现 ， 且 对 于 连 杆 
i 的 计算 ， 就 在 与 连 杆 守 相 关联 的 坐标 系 中 完成 。 蔡 
代 方 案 是 在 绝对 坐标 系 中 实现 算法 ， 在 这 种 情况 下 ， 
所 有 的 计算 都 在 单一 坐标 系 (通常 为 基 连 杆 ) PE 
成 。 在 实际 中 ， 采 用 关节 坐标 来 实现 牛顿 - 欧 拉 算法 
(RNEA) 效率 更 高 ， 这 点 也 适用 于 多 数 其 他 动力 学 

为 将 RNEA 转换 为 连 杆 坐 标 ， 首 先 要 检查 方程 中 
哪些 量 来 自 一 个 以 上 的 关节 。 方 程式 (2.73) MA 
程式 (2.75) PRESERRRRT RD i， 故 不 用 
修正 。 这 样 的 方程 称 为 关节 i 的 局 部 方程 。 其 余 方 程 
中 的 量 来 自 于 一 个 以 上 的 关节 ， 因 而 需要 插入 坐标 转 
换算 阵 。 这 样 方程 式 (2.71)、 式 (2.72) RA 
(2.74) 修正 后 的 形式 为 


vi = 和 Von +P: (2.76) 
a, = Xa) +B 4; + @.q, (2.77) 

及 
f = ft Xf + SKE (2.78) 


jecti) 
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方程 式 (2.78) 假设 外 力 都 作用 在 绝对 坐标 系 
( 即 连 杆 0) 上 。 

完整 的 算法 见 表 2-6。 函 数 jtype 返回 关节 i 的 类 
型 代码 ; 函数 xjcalc 计算 指定 类 型 关节 的 关节 变换 矩 
阵 ; 函数 pcalc 和 pdeale 分 别 计 算 更 A D, KER 
数 应 用 于 各 种 关节 类 型 公式 的 情况 ， 见 表 1.5 和 表 
1.6, 在 一 般 情况 下 ，pcalc 和 pdeale 都 是 需要 的 ， 然 
而 ,对 大 多 数 常 见 的 关节 类 型 ， 在 连 杆 坐标 系 中 


为 已 知 常数 ， 因 而 更 ,为 零 。 如 果 预 先知 道 所 有 关节 
都 具有 这 一 属性 ， 则 可 简化 相关 算法 。 在 关节 坐标 系 
Pit LAX, (i) 均 为 已 知 常数 ， 也 都 是 描述 机 器 人 
机 构 数据 结构 的 一 部 分 。 
表 2.6 空间 矢量 递归 牛顿 - 欧 拉 算 法 

inputs: q, q, q, model,'fe 

output: T 

model data: Ng, jtype(i), p(i), X,(i), L 

Vv, =0 

ao = —a, 
forz=lto N, do 

X; (i) =xjeale(jtype(i), q;) 

‘Xeo =X (i) X, (i) 

if p(i) #0 then 
‘Ko = Ky) Xo 
end 
®©; = pealc(jtype(i), q;) 


Ld 


® =pdcalc( jtype(i), gi, q:;) 


v= ‘X, 


(DYpG) + Bd; 
č: = ® 4: +V x ,gq, 
a; ='X t) apo + @,; q: +Å; 
f; =1;a; tv xI v; -XJT "fS 
end 
for i = N; to 1 do 
T, = @' f, 
if p(i) #0 then 
iyT 
Bo =F) + Kaci f: 
end 


end 





在 第 1 次 循环 中 ， 最 后 一 项 任务 是 将 每 个 工 初始 
化 为 表达 式 ff +X 个 《采用 恒等式 各 =X), R 
(2.78) 右边 的 求 和 在 第 2 次 循环 中 完成 。 此 算法 包 
括 计算 'X% 的 代码 ， 它 用 于 将 外 力 变 换 到 连 杆 坐标 上 ; 


如 果 没 有 外 力 ， 此 代码 可 以 省 略 。 如 果 仅 有 -一 个 集中 
Fi, 例如; 一 个 作用 于 机 械 臂 末 端 执行 器 上 的 外 力 ， 
则 此 代码 可 由 另外 的 代码 来 替代 ,替代 代码 采用 
Xaciy ， 将 外 力 矢量 依次 从 一 个 连 杆 坐标 系 变换 到 下 
一 个 上 。 

注意 : 尽管 “ 连 杆 坐标 ”一 词 表明 我 们 正在 使 
用 移动 坐标 系 ， 事 实 上 算法 是 在 静止 坐标 系 中 实现 
的 ， 它 刚好 在 当前 时 刻 与 移动 坐标 系 一 致 。 

3. 三 维 矢量 递归 牛顿 - 欧 拉 算法 (RNEA) 

RNEA 的 原始 版 本 是 采用 3 维 矢量 开发 和 表达 
HH, R27 显示 了 该 算法 的 一 个 特例 ， 其 中 关 
节 均 假设 为 旋转 关节 ， 且 关节 轴 假 设 与 连 杆 坐标 系 的 
“ 轴 一 臻 《没有 这 些 假 设 ， 方 程 会 长 很 多 ) ， 另 外 假 
设 外 力 为 零 。 

表 2.7 三 维 矢量 递归 牛顿 - 欧 拉 算法 
( 仅 对 旋转 关节 ) 


inputs: q, q, qd , model 
output. T 
model data: Ng, p(i), R (i), p,, mi, €, IP 
wo =0 
Wo =0 
ve — v 
for :=1 to N; do 
Ryo) =rotz(q;) R, (i) 
w; = Ry) op + Lg ; 
w; = ‘Ravi wp) + (CCR woei) ) xz; g; +2; 4: 
vi; ='Rxo( Vaca + (5) x POD p, + 
Opli) X By i) xP) p) 
fi =m, ( v; +o; XC; + @; Xw; XC) 
n; =i" a, +, xio; +C, xf; 
end 
for i = N; to 1 do 


T; =ĉ2 n; 
if p(i) ~0 then 

fro “fan + Roy fi 

Moc) Sapa) + Rich; +P) p, x RY f: 
end 


end 





在 本 算法 中 ，”' 是 由 于 重力 引起 的 线 加 速度 ， 
ERRA ( 连 杆 0) 上 表示 ; rotz 计算 旋转 矩阵 ， 
该 矩阵 表示 坐标 系 沿 z 的 旋转 ; RO) 为 X,(i) 的 


转动 分 量 ; Ro WY Xi 的 转动 分 量 ; pealc 和 
pdcalc 这 里 没有 用 到 ， 因 为 更 ,为 已 知 常数 (2°0° ) ; 


vy! 是 连 杆 i 坐标 原点 (0,) 的 线 加 速度 ， 且 为 关节 
经 典 加 速度 的 直线 分 量 ;"”p, 为 用 p; 坐 标 系 表示 的 ， 
0, 相 当 于 On) 的 位 置 。 另 外 m;、c; 和 I" 为 连 杆 i 的 
惯性 参数 ( 见 表 2.1 中 三 维 量 与 空间 量 关系 的 相关 
WE). 

初 看 起 来 三 维 矢量 算法 明显 不 同 于 空间 矢量 算 
法 。 然 而 可 以 直接 通过 空间 矢量 算法 方便 得 到 三 维 矢 
量 。 具 体 实现 方法 为 : 通过 扩展 空间 矢量 为 三 维 矢 
量 ， 将 关节 类 型 限定 为 旋转 关节 ， 并 将 空间 加 速度 转 
换 为 经 典 加 速度 〈 即 ,按照 式 (2.22) 将 每 个 vM 


b -ow xy 替代) ， 再 将 某 些 三 维 矢 量 恒等式 带 人 表 
2.7 所 示 的 方程 中 。 将 空间 加 速度 变换 为 经 典 加 速 
度 ， 有 一 个 有 趣 的 效应 : v, 抵 偿 了 运动 方程 ， 因 而 不 
需要 计算 。 因 此 ， 三 维 算法 比 空间 算法 具有 微弱 的 束 
度 优势 。 


2.5.2 关节 体 算法 


关节 体 算法 (The Articulated- Body Algorithm, 
ABA) 是 一 种 计算 复杂 度 为 0(Ns) 的 算法 ， 主 要 用 
于 计算 运动 树 的 正 向 运动 力学 问题 。 而 在 正常 情况 
下 ，O(Ns) = O(n) ， 故 我 们 将 其 归 诸 于 O(n) 算法 。 
Featherstone | 提出 了 ABA， 并 将 其 作为 约束 传播 算 
法 的 一 个 例子 。 给 定 关节 位 置 、 速 度 和 作用 力矩 / 力 
变量 ， 这 种 算法 就 可 以 计算 出 关节 加 速度 。 随 着 关节 
加 速度 的 确定 ， 又 可 以 用 数值 积分 进行 机 构 运 动 的 
模拟 。 

ABA 的 重要 概念 如 图 2.7 所 示 。 在 连 杆 i 处 ， 
根子 树 与 运动 树 i 上 其 他 部 分 的 作用 仅 通 过 经 由 关 
节 的 力 卫 来 实现 。 假 设 我 们 在 这 点 将 树 切 断 ， 只 
考虑 受到 作用 于 连 杆 上 的 未 知 力 上 时 子 树 的 运动 情 
况 。 可 以 发 现 ， 连 杆 i 的 加 速度 与 作用 力 有 如 下 
关系 

f, = Ta, +p; (2.79) 
式 中 ，H 为 子 树 (现在 可 称 为 关节 连接 体 ) PRET 
的 关节 体 惯量 ， pi 为 辅助 偏 置 力 (bias force), BUTE 
连 杆 i 出 现 零 加 速度 的 力 。 注 意 在 关 节 体 中 ，Pi 与 单 
个 构件 的 速度 有 关 。 方 程式 (2.79) 考虑 了 子 树 的 
完整 动力 学 问题 ,， 这样 只 要 知道 了 ff 的 值 ， 式 
(2.79) 就 会 立刻 给 出 连 杆 i 的 加 速度 。 

我 们 对 和 p“ 两 个 量 感 兴 趣 的 原因 在 于 ， 可 以 
通过 它们 从 a 计算 得 到 委 ， 依 次 可 以 计算 出 a, 
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= — = 


在 关节 之 处 断 开 连 杆 i 处 的 根子 树 = 关 节 体 i 


图 2.7 关节 体 i 的 定义 


从 而 计算 出 更 多 关节 的 加 速度 。 结 
(2.75) 和 式 (2.79) 得 到 


= @)f,=@7 (Ta + ®, q: +P.) +p?) 
对 可 由 下 式 求解 


合式 (2.72)、 式 


q; =D,(u, — Uia,)) (2. 80) 
其 中 
U, =I @, 
D, = (7U) ` =(P @,)™ 
u, =T; Ti - Ð; p: 
E. 


É, =@.q, =@.q, 十 Vi x @D.q; 
这 样 就 可 通过 式 (2.72) 计算 ai。 
关节 体 惯量 和 偏 置 力 都 可 通过 递归 公式 计算 
I =1,+ >> (五 - U,D,U;) (2.81) 
和 
pi = p, + 2, Pi + Fe, + UDu) (2.82) 
其 中 
p; =v, xIx; -f; 
通过 检验 图 27 中 ff 和 a, 的 关系 ,并 在 假设 和 
p’ 对 每 个 jec(i) 为 已 知 的 情况 下 ， 就 可 以 得 到 这 些 
公式 。 更 详细 的 情况 见 参考 文献 [2. 1, 8, 15, 24]. 
完整 的 算法 见 表 2.8。 表 中 采用 连 杆 坐 标 表 示 ， 
并 按照 表 2.6 的 牛顿 - 欧 拉 算法 (RNEA) ， 通 过 运动 
树 共 进行 3 WERTH. BRN ORM) 回 
末端 (WBE) 迭代， 分 别 运 用 式 (2.76) 计算 连 杆 


速度 和 速度 积 项 4 = 多 ,4;， 并 将 变量 和 pi 初始 化 
HE LAN pi (Pi =v; XN; "Xo 个 ); 第 二 遍 从 项 部 反 
向 基底 迭代 ， 运 用 式 (2.81) AA (2.82) 计算 关 
节 体 惯量 和 每 个 连 杆 的 偏 置 力 ; 第 三 遍 从 基底 向 顶部 
ER, AAR (2.80) AR (2.77) 计算 连 杆 和 关 
节 的 加 速度 。 
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R28 正 向 运动 学 的 关节 体 算法 
inputs: q, q, T, model,° f° 
output; q 
model data; Ng, jtype(i), pCi), X,(i), L 
Vy =0 
ao = 一 au 
for i=1 to N, do 
X,(i) =xjcalc(jtype(i) , q;) 
Xpo =X (KL) 
if p(i) #0 then 
X = Xo X 


end 


®; = pcale( jtype( i), q;) 
®,. = pdealc( jtype(i), q;, @;) 


_i 
v=x, 


(Vp) +B 9; 
oi =®, 4; +v xØ, q; 
r = 了 
pi =v; xiv; -'X,7 Ore 
end 
for :=N, to 1 do 
U; = @, 
D, =(@"U,) ~! 
u; =T; ~ Uit; ~ D; pi 
if p(i) #0 then 
Deo =I + Xpcy H -UDU Y Xpo 
P o) = Phi) + Xio (pf + f+ UD,u,) 
end 
end 
for :=1 to Ns do 


a; = i) Agi) 
qi =D; (u; — U}a;) 
a,=a,+®, q; +Å; 


end 





2.5.3 复合 刚体 算法 


复合 刚体 算法 (CRBA) 是 用 于 计算 运动 树 的 关 
方 空间 惯性 和 矩阵 (JSIM) 的 一 种 方法 。CRBA 最 常见 
的 应 用 是 作为 正身 动力 学 算法 的 一 部 分 ， 该 方法 最 先 
出 现在 参考 文献 [2.5] 的 方法 3 中 。 


在 关节 空间 中 ， 正 向 运动 学 的 任务 是 通过 q、q 


和 TT 计算 q 。 最 常见 的 进行 方式 是 ， 从 式 (2.37) 


开始 ， 先 计算 五 和 Cgq +t, RRM q 求解 线性 
方程 
Hq =T-(Cq +t) (2. 83) 

如 果 机 构 为 运动 树 ， 则 五 和 Cq +Ts 的 计算 复杂 
BRA O(n’) MM O(n), AX (2.83) 可 在 
O(n’) 操作 下 求解 ， 因 而 把 采用 这 种 方法 的 算法 统 
PRA O(n’) 算法 。 然 而 O(n?) 形式 应 考虑 最 坏 的 计 
算 复 杂 度 ， 因 为 实际 复杂 度 取决 于 树 中 的 分 支 数 。 此 
外 ， 即 使 在 最 坏 情况 下 ， 由 于 项 具有 小 系数 ， 直 
到 当 n~60 时 这 项 才 会 起 主导 作用 。 

Cq+T 可 通过 道 向 动力 学 算法 计算 ,如果 
ID(q, q4, q) 是 由 自 变量 q、9q 和 q Hwa 
力学 计算 的 结果 ， 则 

ID(q,4,q) =T=Hq +Cq +t, 
故 有 
Cq +T =ID(q, q, 0) (2. 84) 

这 样 对 于 运动 树 而 言 ，Cq + 到 的 值 可 用 q =0 
时 的 RNEA 进行 计算 。 

复合 刚体 算法 (CRBA) 的 一 个 重要 概念 就 是 要 
注意 ISM 只 取决 于 关节 的 位 置 ， 而 不 是 速度 ， 
CRBA 所 作 的 简化 假设 是 让 每 个 关节 的 速度 为 零 。 如 


本 也 假设 重力 为 零 ， 则 可 从 式 (2.83) 中 消除 Cq + 
zs。 此 外 对 于 旋转 关节 ， 在 第 j 个 关节 上 作用 一 个 单 
位 加 速度 ， 就 产生 JSM 中 的 第 7 列 ， 这 样 将 机 构 划 
分 成 两 个 复合 刚体 ， 彼 此 通过 第 7 个 关节 相连 ， 此 方 
法 就 大 大 简化 了 动力 学 问题 。 这 已 使 CRBA 推广 应 用 
到 运动 树 结 构 的 任意 关节 类 型 。 
可 以 证 明 对 于 运动 树 ，JSIM 的 一 般 形式 为 
PIO, WF iec* (j) 
Hy =( P'O, WR jec’ (i) 
0 其 他 
A, c(i) 是 连 杆 ;处 的 根子 树 上 所 有 连 杆 集 ( 包 
fat AE), H 


(2. 85) 


= 》 7 
jee * (i) 

见 参 考 文献 (2.8, 15], FXE, 起 为 复合 刚体 的 惯 
E. 复合 刚体 由 c"(i) 上 的 所 有 连 杆 刚性 装配 而 成 ， 

该 算法 由 此 而 得 名 。 
式 (2.85) 和 式 (2.86) 为 表 2.9 所 示 算 法 的 基 
础 ， 它 是 在 连 杆 坐标 系 下 的 复合 刚体 算法 (CRBA ) 。 
BREE eX, 和 本 ,已 经 计算 出 来 (如 在 计算 


(2. 86) 


Ca +zs 时 已 计算 ) ， 如 果 不 是 这 种 情况 ， 则 可 从 表 
2. 6 中 相应 行 中 插入 第 一 个 循环 ; EE F 为 一 局 部 
变量 ; 如 果 在 树 上 没有 分 支 , H=0, 第 一 步 可 以 
省 略 。 
表 2.9 复合 刚体 算法 计算 JSIM 
inputs: model, RNEA partial results 
output; H 
model data: Ng, p(t), L; 
RNEA data; @, Xi 
H=0 
for i=1 to Ns do 
If =I, 
end 
for i=N, to 1 do 
F =I; @, 
H; = @;'F 
if p(i) 40 then 
Tray = Bye + Xp LX pc 
end 
j=l 
while p{]) #0 do 
F='Xp()F 
7=p()) 
H;=F'g 
H; =H; 
end 


end 


计算 出 Cd +Te 和 五 后 ,最 后 一 步 是 在 式 (2. 83) 


中 对 q 求解 ， 可 采用 标准 的 Cholesky 分 解 或 LDL 
分 解 来 完成 。 注 意 互 可 能 具有 高 病态 性 “” ， 这 反 
映 了 运动 树 本 身 潜 在 具有 病态 性 ， 故 推荐 在 正 向 动力 
学 计算 中 ， 每 一 步 都 采用 双 精 度 算 法 〈 本 建议 也 适 
用 于 ABA). 

A (2.85) RRM RIA LAM, WH H 
一 些 元 素 自 动 为 零 。 图 2. 8 为 这 种 影响 的 例子 ， 可 以 
看 出 近 半数 的 元 素 为 零 ， 因 而 有 可 能 利用 稀 琉 性 进行 
分 解 ， 其 算法 描述 见 参 考 文献 12.25] 。 根 据 树 的 分 
支 量 大 小 ， 稀 朴 算 法 有 时 会 比 标准 算法 快 许多 倍 。 


2.5.4 操作 空间 惯性 矩阵 


操作 空间 矩阵 (OSIM) 可 用 两 种 算法 计算 。 第 
一 种 是 O(n?) 算法 ， 它 采用 OSIM 的 基本 定义 ， 随 
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2.8 分 支 引 起 的 稀 朴 性 : 运动 树 上 的 分 支 臻 
使 JSM 的 某 些 元 素 为 0 


同 JSIM 一 起 进行 有 效 的 分 解 ; 第 二 种 是 O(n) 算法 ， 
它 是 基于 正 向 动力 学 问题 的 有 效 解 。 

1. 采用 基本 定义 的 算法 

如 果 机 器 人 具有 较 少 相关 自由 度 〈 如 6 个 )， 骨 
计算 OSIM 最 有 效 的 方法 是 通过 式 (2. 52) 进行 ,其 
过 程 如 下 : 

1) 通过 CRBA 计算 H, 

2) $8 HA} REA H =LL" (Cholesky 分 解 ) 。 

3) 使 用 回 代 计 算 Y 了 =L J. 

4) A =Y'Y, 

5) 分 解 4- (可 选 ) 。 

最 后 一 步 唯一 可 能 是 ,末端 执行 器 具有 完整 的 6 
个 自由 度 ， 且 需要 用 到 4 而 不 是 4 。 第 二 步 中 ， 
对 于 有 分 支 的 运动 树 ， 可 用 LDL 分 解 代替 LL 分 解 ， 
或 者 采用 参考 文献 [2.25] 中 描述 的 分 解 方 法 。 

式 (2.38) 中 的 其 他 项 可 由 式 (2.53) MA 
(2.54) 计算 得 到 。 特 别 地 ， 式 (2.38) 可 写成 如 下 
形式 

v +A`'(x)la(x,v) +p(x)] = 人- (x)f 
(2. 87) 
WA, A (1 +p) 可 通过 下 述 公式 计算 
A` (p +p) =JB'(Cà+Te)-Jq (2.88) 
AF, Ja 项 是 式 (2.50) 中 末端 执行 器 的 速度 积 形 
式 的 加 速度 ， 它 可 由 RNEA 的 式 (2.84) 计算 Cq + 


Tt: 时 顺便 得 到 。 特 别 地 ，J 9 =a. -ao， 这 里 ait 
算得 到 的 末端 执行 器 的 加 速度 (在 同一 个 坐标 系 时 


用 v 表示 ) ，ao 是 基 加 速度 - ae。 

2. O(n) 算法 

X n 值 足 够 大 时 ， 采 用 O(n) 算法 更 为 有 效 ， 这 
种 算法 更 多 详情 见 参考 文献 [2.27-29 ]。 本 市 给 出 
了 更 简单 的 算法 ， 它 是 基于 关节 空间 正 向 动力 学 问题 
的 O(n) 算法 (例如 通过 ABA)。 它 是 单位 力 方 
ES 的 一 种 变 体 ， 用 于 计算 OSIM 的 逆 。 

从 式 (2. 87) 中 开始 ， 观 察 到 4A” 仅 是 位 置 的 函 
数 ， 动 力学 方程 中 的 一 些 项 可 以 忽略 而 不 影响 其 值 。 
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特别 是 当 关 节 速 度 9、 关 节 力 tT 以 及 重力 均 设 为 零 
时 ，A 的 值 将 保持 不 变 ， 在 这 种 条 件 下 . 
v=A-!'f (2. 89) 
我 们 定义 一 个 六 维 坐标 撩 量 译 ， 令 其 值 在 第 i 
个 坐标 时 为 1， 其 余地 方 都 为 零 。 如 果 在 式 (2.89) 
中 令 f= 人 8， 则 v 将 等 于 4 的 第 ; 列 。 我 们 同样 定 
XR FDC, j, q, 4, %, T, £), CHITE KZ 
力学 计算 ， 并 返回 连 杆 守 的 真实 加 速度 (a -a ), 
它 在 同一 个 坐标 系 时 表示 为 f ORKER). 
变量 q、q 和 7T 分 别 设 为 关节 位 置 、 速 度 和 力 变量 
的 值 。 这 里 7 和 了 上 指 施 加 于 连 杆 7 的 外 力 f。 自 变量 
ao 为 包含 重力 影响 的 虚拟 基 的 加 速度 ， 其 值 设 为 0 
或 -a,。 
通过 上 述 定义 ， 得 到 
(A~')'=FD(ee, ee, q, 0, 0,0, &) (2.90) 
及 
A`'(u +p) = — FD(ee, ee, q, q, —a,, T, 0), 
(2.91) 
AP, (AT EEA AGS iJ, ee 为 末端 执行 器 的 构 
件数 。 因 此 式 (2.87) 的 系数 可 以 采用 表 2.10 的 算 
法 计算 出 来 ， 此 算法 复杂 度 为 O(n). 


表 2.10 用 于 计算 操作 空间 惯性 矩阵 的 逆 
及 其 他 项 的 算法 
for ;=1 to 6 do 
vi =FD(ee, ee, q, 0, 0, 0, ê, ) 
end 


A`! (u +p) = ~ FD(ee, e, g, q, -a T, 0) 


g? 





注意 当 计 算 4 有 如 下 情形 时 ， 计 算 效 率 会 显著 
提高 : ABA 算法 中 v, CAT WERE ( 见 表 2.8)， 
且 五 及 一 些 量 (与 UV, 和 DD, 相关 ) 只 需 计算 一 次 ， 因 
为 它们 不 随 作用 力 而 改变 。 此 外 ， 该 方法 可 用 于 多 个 
末端 执 行 器 ， 它 通过 调节 FD 来 接受 未 端 执行 器 构件 
数列 表 ， 放 和 第 1 个 自 变 量 中 ， 并 返回 一 个 包含 所 有 
指定 构件 加 速度 的 复合 矢量 。 表 2. 10 中 的 算法 附 上 
一 个 for 循环 来 控制 FD 的 第 2 个 自 变 量 ， 并 遍及 所 
有 末端 执行 器 构件 数 进行 迭代 *”。 然 而 对 于 只 有 几 
个 末端 执行 器 的 情况 ，Lilly*”1 的 力 传播 方法 应 更 适 
于 提高 计算 效率 。 如 果 有 m 个 末端 执行 器 ， 则 复杂 
EX Olm n)。 


2.6 运动 环 

上 市 中 所 有 算法 都 是 用 于 运动 树 的 ， 本 节 将 最 后 
提供 一 种 算法 ， 用 于 闭环 系统 的 正 向 动力 学 问题 。 该 
算法 对 于 闭环 系统 的 生成 树 问 题 补充 了 运动 体 的 动力 
学 方程 ， 以 及 闭环 约束 方程 ， 给 出 了 三 种 不 同 的 方法 
来 求解 由 此 产生 的 线性 方程 组 ， 并 给 出 了 一 种 用 于 计 
算 闭 环 约 束 的 有 效 算法 。 

与 运动 树 相 比 ， 带 有 封闭 运动 环 的 系统 ， 具 有 更 
复杂 的 动力 学 特性 ， 例 如 ， 

1) 运动 树 的 运动 自由 度 是 固定 的 ， 而 闭环 系统 
的 运动 自由 度 可 以 变化 。 

2) 运动 树 中 ， 瞬 时 运动 自由 度 总 是 与 有 限 运动 
目 由 度 相 同 ， 但 它们 在 闭环 系统 中 可 以 不 同 。 

3) 运动 树 中 每 个 力 均 可 确定 ， 而 闭环 系统 中 的 
某 些 力 可 为 不 确定 。 只 要 闭环 系统 是 过 约束 的 ， 这 种 
情况 就 会 出 现 。 

图 2. 9 为 这 种 现象 的 两 个 例子 。 在 图 2. 9a 的 机 
构 中 ,没有 有 限 运 动 自由 度 ， 但 有 两 个 无 限 小 运动 自 
由 度 。 图 2. 9b 所 示 的 机 构 ， 当 9z0 时 有 一 个 自由 
度 ， 而 如 果 6=0， 则 两 个 辟 A MB 能 独立 运动 ， 机 
构 有 两 个 自由 度 。 此 外 ， 在 这 两 个 运动 的 状态 边界 
上 ,机构 有 具有 3 个 无 限 小 运动 自由 度 。 这 两 种 机 构 都 
是 平面 的 ， 均 为 过 约束 情况 ， 因 此 关节 约束 力 的 面 外 
分 量 是 不 确定 的 。 这 类 不 确定 性 对 机 构 运 动 无 影响 ， 
但 它 使 动力 学 计算 变 得 复杂 。 


| AZ 
。 V 


图 2.9 病态 闭环 系统 


a) 


2.6.1 闭环 算法 公式 
一 个 团 环 系统 可 以 模拟 为 受到 一 组 闭环 约束 力 的 
生成 树 ， 如 果 
Hq +Cq +Te =T 
是 生成 树 自身 的 运动 方程 ， 则 闭环 系统 的 运动 方程 为 
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Hq +Cq +t+Ts =T+T* +T (2. 92) 
式 中 ，T* 和 TT* 分 别 为 用 生成 树 广 义 力 坐标 表示 的 闭环 
主动 力 和 约束 力 和 撩 量 。T* 为 已 知 量 ， 而 不 未 知 ，T™" 来 
自作 用 于 闭环 关节 的 力 元 件 〈 弹 簧 、 阻 尼 央 和 驱动 
器 ) ， 如 果 没 有 这 类 元 件 ， 则 TT =0。 
闭环 约束 限制 了 生成 树 的 运动 ， 在 加 速度 级 别 ， 
这 些 约束 可 以 表示 为 线性 方程 的 形式 
Lg =1 (2.93) 
RP, LA n xn 的 矩阵 ; rw 是 缘 于 闭环 关节 的 约束 
数 ， 用 公式 给 定 如 下 : 
NJ 


c (4 
n = > ny, 
k=NBp+l 


式 中 ，ni 为 关节 上 施加 的 约束 数 。 如 果 rank(L) <n’, 
则 闭环 约束 线性 相关 ， 且 闭环 机 构 为 过 约束 。 闭 环 系 
统 的 机 动 性 ， 即 它 的 自由 度 ， 由 以 下 公式 给 出 
mobility =n — rank( L) (2.95) 
给 出 了 式 (2.93) 形式 的 约束 方程 ， 接 下 来 约 
RA mA 


(2.94) 


T=L'A (2. 96) 
RP, A= (Anp An) Arn’ x1 的 未 知 约束 变量 的 
矢量 (RRR ORT). 。 如 果 机 构 为 过 约束 ， 则 
"将 为 零 空间 ， 晶 A 位 于 此 零 空 间 的 分 量 将 不 确定 。 
通常 可 以 预先 确定 宛 余 约束 。 例 如 ， 如 果 运 动 环 
已 知 为 平面 ， 则 面 外 的 闭环 约束 是 多 余 的 。 在 这 种 情 
况 下 ， 有 利于 消除 相关 工 的 行 ， 以 及 了 入 的 元 素 ， 
A 的 移 除 元 素 可 赋值 为 零 。 
对 于 闭环 系统 ， 由 式 (2.92)、 式 (2.93) KA 
(2.96) 可 得 如 下 运动 方程 


H Ai 本 (2.97) 
L 0/\-a 1 


系统 矩阵 对 称 ， 但 为 不 定 。 如 果 工 为 满 秩 ， 则 
系统 矩阵 为 非 奇 异 矩 阵 ; 否则 将 是 奇异 的 ， 上 且 入 的 
一 个 或 多 个 元 素 将 不 确定 。 

方程 式 (2. 97) 可 通过 下 列 任 一 种 方法 求解 : 

1) 直接 对 q AA RSF. 

2) 先 解 入， 再 用 其 结果 求解 q 。 


3) 由 式 (2.93) 求解 q, 把 结果 带 入 式 
(2.92) ， 消 去 未 知 约束 力 ， 再 求解 剩余 的 未 知 量 。 

方法 1) 是 最 简单 的 ,但 通常 效率 最 低 ， 此 方法 迁 
用 于 当 系 统 矩 阵 为 非 奇 异 的 情况 。 当 系统 矩阵 为 (n+ 
n°?) x (n+n*) 时 ,此 方法 复杂 度 为 O( ntn Y )。 

方法 2) 对 于 n>>n* 的 情况 特别 有 用 ， 并 可 在 生 
成 树 上 采用 O(n) AAE, Ha (2.97) 得 


LH'L'A=1-LH'[T+T - (Cq +7.) | 
(2.98) 
通过 O(n) 算法 , JEE Onlan) ) 操作 中 
用 公式 表示 ,在 0((n°)*) RMB. HAGA, TA 
由 式 (2.96) Æ O(n n) 操作 中 计算 ， 且 通过 
O(n) 算法 在 式 (2.96) 中 求解 ， 故 总 的 复杂 度 为 
O(n(n')? +(n°)*), MRL RR, WLR CL HEA 
iy, (aE eH, Bk (2.97) 中 的 不 定 
系统 矩阵 的 奇异 情况 相 比 ， 提 出 的 分 解 方法 稍微 容 
易 些 。 
方法 3) 适用 于 当 n -产值 很 小 ， 或 者 当 工 预期 
为 欠 秩 的 情况 。 式 (2.93) 通过 高 斯 消 元 法 的 专用 
版 (或 类 似 的 程序 ) 求解 ， 它 配备 了 数值 秩 检验 程 
序 ， 其 目的 是 求解 欠 确 定 系 统 。 其 解 是 一 个 方程 的 
形式 
q = Ky + Go 
式 中 ，g Akt (2.93) 的 任 一 特 解 ; K An x (n- 
rank(L)) 矩阵 ， 并 有 ZE=0; y HARA n-rank(L) 
个 未 知 数 的 矢量 GH, y 与 4 元 素 的 子 集 线 性 无 
关 )。 将 q 的 表达 式 带 人 式 (2.92) ， 并 两 边 左 乘 
KET, 得 到 
K"HKy =K'"(t+T*-(Cq+ts)-Hq,) (2.99) 
这 种 方法 也 具有 立方 关系 的 复杂 度 ， 但 如 采 半 于 


很 小 时 ， 此 方法 是 最 有 效 的 。 有 报告 称 此 方法 比方 法 
1) ERE U, 


2.6.2 闭环 算法 


计算 五 和 Cgq + TT 算法 可 分 别 在 2.5.3 PA 
2.5.1 节 中 找到 ， 这 里 只 剩 下 L、I 和 7T* 三 个 等 求 值 。 
为 简单 起 见 ， 我 们 假设 所 有 的 闭环 关节 均 为 零 自由 度 
关节 。 为 不 失 一 般 性 ， 假 设 : 将 连 杆 切 开 用 关节 代 
兰 ， 简 单 形成 开 环 ( 见 图 2.10)。 然 而 这 样 做 可 能 会 
导致 损失 部 分 效率 。 在 这 个 假设 下 ， 我 们 只 需要 计算 
LAI, AAT =0, 





动力 学 等 效 Í +h=l 


图 2. 10 在 准备 将 环 切 开 的 地 方 插入 一 个 零 自由 度 关节 
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1, 环 约束 
一 般 情况 下 对 于 环 k， 速 度 约束 方程 为 


(Ci) (Von -Va ) =O (2. 100) 
加 速度 约束 为 
(Ci) (ab — Agcy) + (DE) TV — Voce) ) =O 
(2. 101) 


然而 ， 如 果 每 个 闭环 关节 均 为 零 自由 度 ， 则 上 述 
方程 简化 为 

Yam 一 Yo =O (2. 102) 

Ay.) Zapa =0 (2. 103) 

定义 一 个 环 雅 可 比 (loop Jacobian) 48 RE J,, € 


具有 以 下 特性 


Vick) — Vn = Se (2. 104) 
AP, J,A 6 xz 的 矩阵 ， 用 公式 定义 为 
J, = (ex ey, Dy, ) (2. 105 ) 


其 中 
+1 WB s(k) ec* (i), H p(k) ¢e* (i) 
Eg = | -1 WR p(k) ec" (i), Hs(k) ¢c* (i) 
0 其 他 
换言之 ， 如 果 关 节 i 取决 于 路 径 ;(k) 而 不 是 
p(k), Whe, = +1; WRR T i RAF REI p(k) 
Nye s(k), We,=-1; 而 当 关节 同时 取决 于 两 条 
路 径 或 者 都 不 是 时 ， 则 e, =0。 
环 加 速度 约束 可 记 为 
0 = an — a 
or (2. 106) 
=J, q + ai) 一 (有 
式 中 ，a? 是 连 杆 i 的 速度 积 形式 的 加 速度 ， 这 是 当 
q 为 零 时 连 杆 可 能 具有 的 加 速度 。 每 个 连 杆 的 速度 
积 加 速度 在 式 (2.84) 计算 Cd + Ts 时 一 并 计算 。 如 
采用 RNEA 计算 Ca +t, M ap? 将 具有 a 的 值 ， 其 通 


过 RNEA 计算 时 加 速度 变量 设 为 零 。 
矩阵 和 了 现在 可 表示 为 如 下 形式 : 
Lygai lypsi 
L= : I= : (2. 107) 
Ly, Ly, 
其 中 
L =J, (2. 108) 
l, = a ~ a) (2. 109) 
2. 约束 稳定 性 


在 实际 中 ， 因 为 存在 数值 积分 误差 ， 必 须 控制 闭 
环 约束 的 稳定 性 ， 否 则 模拟 计算 中 就 会 发 散 。 这 项 标 


准 技 术 应 归功 于 Baumgarte 3734 ， 他 将 每 个 约束 方 
EMH a, =0 形式 替换 为 
Ce + Kv, +K,p, =0 

式 中 ，a。、v。 和 pp 分 别 为 加 速度 误差 、 速度 误差 和 位 
ERA, H KAK HERY. 通常 选择 一 个 时 间 常 
te, 它 主 要 根据 期 望 多 快 到 该 位 置 和 速度 误差 的 训 
减 来 确定 ， 然 后 由 公式 天 =2/1,. K, = LE 来 给 定 
kK,、K,。 然 而 ， 选 择 t. 并 没有 一 个 很 好 的 标准 。 如 果 
i 时间 太 长 ， 闭 环 误差 的 累积 快 于 衰减 ， 如 果 A, 
则 运动 方程 变 硬 ， 造 成 数值 积分 精度 损失 。 对 于 大 而 
速度 慢 的 工业 机 器 人 ， 合 理 值 取 为 上 =0.1， 而 对 于 
小 而 快 的 机 器 人 ， 可 以 设 为 上 =0.01, 

将 稳定 性 项 代入 约束 方程 ， 则 式 (2. 109) $ 
换 为 

lL, = ah) 一 aA) -= K, (Vi =V) -KPa 
(2.110) 

式 中 ,p44 为 矢量 ,表示 环 上 的 位 置 误差 。 在 绝对 坐 
IRA F (BIEI O 坐标 系 )，pw 给 定 如 下 ， 

Pe = x_to_vec(°X) y Xn (k) Xn ( ky Xo) 

(2.111) 

AH, Xu (k) M Xn (k) 变换 在 式 (202) MÈ 
(2.63) FEX, XTA k E24, x_to_vec(*X,) 
用 于 计算 从 坐标 系 4 BB MIE, Bee 
为 无 限 小 。x_to_vec 定义 如 下 : 

— Xa 

-X 
x_to_vec( X) -L An ~ Kat (2. 112) 
a 2 X53 -Xe 


Xe Xa 
Xy Xs 
3. 算法 
作为 一 个 特例 ， 即 当 所 有 闭环 关节 都 具有 零 自 由 
度 时 ， 表 2. 11 给 出 了 用 于 计算 工 和 1 的 算法 。 为 实 
现 对 每 个 量 进行 简单 而 高 效 的 变换 ， 需 要 将 闭环 约束 
公式 放 人 单一 坐标 系 中 。 在 绝对 坐标 系 下 的 情形 时 
《 连 杆 0) ， 则 不 需要 进一步 变换 。 
第 一 个 循环 计算 绝对 坐标 到 连 杆 坐标 的 变换 ， 并 
将 ;变换 到 绝对 坐标 系 下 ， 这 里 更 仅 在 闭环 约束 中 
才 需 要 变换 。 
第 二 个 循环 根据 式 (2. 105) 计算 工 的 非 零 元 素 ， 
可 以 为 稀 朴 。 内 while 循环 在 循环 的 根部 终止 ， 它 为 连 
FF p(k) 和 s(k) 的 最 高 编号 数 ( 共 祖 )， 如 果 没 有 其 
他 共 祖 ， 则 它 为 固定 基 。 通 过 方程 式 (2. 110) ,在 绝 
对 坐标 系 下 计算 出 I 后 ,第 二 循环 终止 。 
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表 2.11 闭环 约束 算法 


inputs: model, RNEA partial results 
output: L, I 
model data: Ng, pli), Nj, p(k), s(k), EBC), 
Xi(k), Xalk), K,, K, 
RNEA data: BD;, Ki), Voce) 2 Ysk)» arta? alo 
for i=1 to Ns do 
if p( 1) +0 then 
‘Xo =X py Xo 
end 
if LB(i) Anull then 
oD, = 和 
end 
end 
L=0 
for k =N, +1 to N, do 
i= p(k) 
j=s(k) 
while : =; do 
if : >j then 
L;i = —"@, 
i=p() 


j=p()) 
end 
end 
5 一 1 k -lav 
a, =") Xg ave, —? Ko arty) 


Vv, = sth) y I Ye _ plk) Xg’ ve 
p, =x_to_vec (PP Xo Xn (b) Xin (bk) Xo) 
L, = —a, -K,v, — Kp, 


end 





2.7 结论 与 扩展 阅读 
本 章 提出 了 应 用 于 机 器 人 机 构 的 刚体 动力 学 基本 
原理 ， 主 要 包含 以 下 主题 : 空间 矢量 代数 ， 它 提供 了 
用 于 描述 和 实现 动力 学 方程 及 算法 的 简明 记 法 ; Plat 
人 学 中 最 常用 的 运动 正则 方程 ;如 何 构建 机 器 人 的 动 
力学 模型 ， 几 个 基于 模型 的 有 效 算法 ， 用 于 计算 逆 问 
动力 学 、 正 向 动力 学 ， 以 及 关节 空间 和 操作 空间 惯性 
矩阵 。 

另外 还 有 许多 动力 学 领域 的 主题 本 章 没 有 提 及 ， 
但 会 在 本 书后 面 章 节 中 讲述 。 有 关 弹 性 连 杆 和 关节 的 


机 器 人 动力 学 问题 见 第 13 章 ; 动态 模型 参数 识别 问 
题 见 第 14 章 ; 第 27 章 讲 述 了 机 器 人 与 外 界 目 标 之 间 
物理 接触 的 动力 学 问题 ; 第 45 章 讲 述 了 具有 浮 基 的 
机 器 人 动力 学 问题 。 

在 本 章 结束 之 际 ， 做 一 些 阅 读 提 示 ， 机 器 人 运动 
学 简 史 见 参考 文献 [2.32] ， 更 多 涉及 机 器 人 动力 学 
的 问题 可 以 从 这 些 书 籍 中 找到 ， 见 参考 文献 [2.8， 
10，1$S，28，33-35]。 最 后 ， 对 扩展 阅读 提出 如 下 
建议 。 


2.7.1 多 体 动力 学 


机 器 人 动力 学 可 视 为 更 为 广泛 的 多 体 动力 学 学 
科 的 一 个 子 集 或 一 种 具体 应 用 。 有 关 多 体 动 力学 的 
书籍 包括 参考 文献 [2.3，14，31，3-41 ] 。 当 然 ， 
多 体 动力 学 又 是 经 典 力学 的 一 个 子 集 ， 它 的 数学 基 
础 可 以 在 任意 一 本 经 典 力学 的 书 中 找到 ， 如 和 参考 文 
献 [2.13]. 


替代 表示 法 


本 章 采 用 空间 矢量 来 表示 运动 方程 。 另 外 还 有 各 
种 可 选 的 替代 方法 用 于 空间 矢量 表示 ， 如 其 他 类 型 的 
六 维 矢量 、 三 维 矢 量 、4 x4 矩阵 以 及 空间 算 子 代数 


2.7.2 


等 。 所 有 的 六 维 矢 量 形式 是 相似 的 ,但 又 不 完全 相 


同 。 主 要 的 供 选 方案 有 : 旋 量 *””、 对 偶 矢 
BPS, ARAP, URERA, Hh 
一 种 特别 记 法 是 将 三 维 矢量 都 组 成 对 ， 用 以 减 小 代数 
式 的 体积 。 三 维 矢量 形式 用 于 大 多 数 经 典 力学 和 多 体 
教科 书 中 ， 它 也 是 六 维 矢 量 和 4 x4 矩阵 的 前 号。4 x, 
4 矩阵 在 机 器 人 学 领域 广 受 欢迎 ， 因 为 它 非常 适用 于 
运动 学 ， 但 对 动力 学 则 没 那么 有 用 。4 x4 矩阵 的 动 
力学 公式 见 参考 文献 [2.33, 44，45]。 空 间 矢 量 代 
数 由 JPL 实验 室 (Jet Propulsion Laboratory) 的 
Rodriguez 等 人 提出 ， 它 采用 6N 维 矢量 和 6N x ON Hi 
阵 ， 后 者 被 当做 一 个 线性 算 子 ， 这 种 记 法 的 例子 见 参 
考 文 献 [2. 46-48], 


替代 公式 


本 章 采 用 的 运动 方程 矢量 公式 通常 称 作 牛顿 - 欧 
拉 公式 。 主 要 的 替代 公式 为 拉 格 朗 日 公式 ， 其 运动 
方程 通过 拉 格 朗 日 方程 得 到 ， 拉 格 朗 日 公式 的 例子 
见 参考 文献 (2.9, 10, 17, 49, 50], AS, TB 
(Kane) 方法 也 可 用 于 机 器 人 学 中 。 


2.7.4 效率 
因为 实时 执行 ， 特 别 是 实时 控制 的 需要 ， 机 玫 


2.7.3 
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人 界 非 常 关注 计算 的 效率 问题 。 对 于 逆向 动力 学 ， 
Luh 等 人 的 O(n) 递归 牛顿 - 欧 拉 算法 (RNEA) 仍 
然 是 最 重要 的 算法 ， 该 算法 的 进一步 改进 见 参考 文 
献 [2.53，54]。 对 于 正 向 动力 学 ， 本章 列 举 的 两 
种 算法 ， 仍 可 作为 计算 中 的 重点 考虑 ， Featherstone 
提出 的 O(n) 关节 体 算法 (ABA)?! MÆ Walker 
和 Orin 的 基于 复合 刚体 算法 (CRBA) 的 O(n?) 
BIR), ABA 方法 经 过 多 年 改进 2 SA ， 对 于 
n 值 很 小 的 情况 ， 它 比 CRBA 效率 更 高 。 然 而 ， 随 
着 近年 CRBA 在 有 分 支 的 运动 树 问题 ”和 机 器 
人 运动 控制 系统 的 应 用 ”” ，CRBA 方法 的 优势 逐 
渐 展 现 。 

对 于 关节 空间 惯性 矩阵 ，CRBA 仍 是 目前 最 重要 
的 算法 “5 ， 儿 年 来 也 进行 了 若干 改进 和 修正 ， 以 提 
高 计算 效率 ““”““ 。 对 于 操作 空间 惯性 矩阵 ， 提 出 
了 有 效 的 Oln) BRR) ， 并 应 用 于 日 益 复 杂 的 
Bgl? '9) 。 


2.7.5 精度 


精度 问题 主要 涉及 动力 学 算法 的 数值 精度 、 模 拟 
精度 ( 即 数值 积分 精度 ) ， 以 及 动力 学 模型 精度 。 与 
效率 相 比 ， 动 力学 算法 的 数值 精度 很 少 受 到 关注 。 虽 
然 RNEA、CRBA 和 ABA 都 已 通过 了 各 种 刚体 系统 的 
精度 测试 ， 但 还 不 能 说 其 他 算法 都 能 通过 测试 。 刚 体 
系统 经 常 是 病态 的 ， 在 这 个 意义 上 ， 一 个 小 的 外 力 变 
化 (或 者 模型 参数 变化 ) ， 就 会 导致 加 速度 的 很 大 变 
化 。Featherstone 研究 了 这 一 现象 下， 他 发 现 ME 
构件 数 的 增加 ， 病 态 情 形 会 变 差 ， 在 最 坏 的 情况 下 ， 
病态 增长 与 0(n:) 成 正比 。 关 于 这 一 主题 的 其 他 文 
献 见 参考 文献 [2.8, 30, 59, 60], 


2.7.6 软件 包 


对 于 多 体系 统 ， 特 别 是 机 器 人 系统 ， 已 开发 了 许 
多 软件 包 ， 用 于 动力 学 问题 的 仿真 。 为 积分 方便 ， 其 
中 一 些 是 用 MATLAB @ 编写 的 用 于 分 析 、 控 制 及 仿 
真 的 程序 。 这 些 程序 大 多 都 是 开源 的 ， 有 些 则 是 以 很 
低 的 价格 提供 给 用 户 。 这 些 软件 能 力 上 的 不 同 主要 体 
现在 计算 速度 、 拓 扑 及 关节 模型 支持 、 精 度 、 基 本 的 
动力 学 公式 及 相关 的 复杂 度 、 用 户 界面 图 形 支持 、 数 
值 积 分 程序 、 与 其 他 代码 的 集成 、 应 用 支持 、 价 格 
等 。 其 中 常用 的 软件 包 有 : Adams. Autolev!? 7! 、 


DynaMechs'’* *! | Open Dynamics Engine“! | Robotics 


Studio “55] 、 Robotics Toolbox!? ©! | 
SimMechanics'? ©! , ELE Webots!? ®! o 


符号 简化 


符号 简化 技术 采用 通用 的 动力 学 算法 ， 经 符号 处 
理 后 用 于 具体 的 动力 学 模型 ， 其 结果 为 一 个 任务 陈述 
列表 。 要 是 该 算法 以 前 曾经 执行 过 ， 列 表 就 会 详细 列 
出 算法 现在 将 要 如 何 运行 ， 然 后 检查 和 修剪 所 有 不 必 
要 的 计算 , 余下 的 有 用 程序 用 计算 机 源 代码 形式 输出 
到 一 个 文本 文件 中 。 这 个 生成 的 代码 在 运行 时 比 采 用 
原始 通用 算法 的 代码 要 快 10 倍 ， 但 这 只 适用 于 具体 
的 单个 动力 学 模型 。Autolev'* 中 和 S/DFAST "1 软件 
都 采用 这 种 技术 ， 其 他 有 关 动 力学 符号 简化 的 出 版 物 
包括 参考 文献 [2. 70-75]. 


2.7.8 并 行 计算 算法 


为 加 快 动力 学 计算 速度 ， 开 发 了 许多 算法 用 于 
并 行 计算 机 和 流水 计算 机 。 对 于 逆向 动力 学 ， 早 期 
的 工作 集中 在 将 O(n) RNEA 用 到 nn 个 处 理 器 
LP" ， 随 后 出 现 了 0(log,n) Beye?) 。 对 于 
用 O(n’) CRBA 计算 关节 空间 惯性 矩阵 ， 起 初 是 对 
n AREA, H O(log.n) 算法 计算 复合 刚体 惯量 和 
FE BE BS RT ACE ， 后 来 对 O(n?) 个 处 理 器 采 
用 O(Clog,n) 算法 计算 整个 矩阵 31。 对 于 正 向 动 
力学 ， 多 机 械 辟 系 统 的 加 速 ， 主 要 依靠 并 行 /流水 超 
级 计算 机 获得 “]。 这 方面 起 初 开发 了 n 个 处 理 器 的 
O(logn) 算法 ， 用 于 无 分 支 的 品行 链 *”]， 最 近 的 
研究 主要 集中 在 用 0(log,n) 算法 处 理 更 为 复杂 的 


2. 60,86,87 
结构 ! i, 


SD/FAST!?: 9 、 


2.7.7 


2.7.9 SHIRA 


许多 机 器 人 机 构 ， 其 拓扑 结构 会 随时 间 变 化 ， 因 
为 接触 条 件 (特别 是 外 界 环境 ) 发 生 了 变化 ， 如 在 
有 腿 车 中 ， 采 用 柔性 地 面 接触 模型 来 计算 接触 力 ， 可 
将 闭环 结构 简化 为 树 结构 *”， 然 而 过 到 接触 面 很 坚 
硬 的 情况 ， 就 会 产生 数值 积分 问题 。 最 近 的 研究 工 
作 “”…” ， 提 出 了 硬 接触 约束 假设 。 采 用 这 种 方法 可 
大 大 减少 坐标 变量 的 个 数 ， 而 这 些 变量 数 在 通用 运动 
分 析 系 统 中 ， 则 可 能 是 必须 的 *”。 同 时 ， 当 结构 变 
化 时 ， 它 们 能 自动 识别 变量 ; 在 构 型 改变 后 ， 能 提出 
相应 的 方法 ， 用 于 计算 速度 边界 条 件 ““ 2 。 
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3.1 概述 


通常 把 诸如 横梁 、 连 杆 、 铸 件 、 轴 、 滑 轨 和 轴承 
等 能 产生 可 移动 骨架 的 物理 结构 ， 称 为 一 个 机 器 人 的 
机 械 结 构 或 者 机 械 装 置 。 而 电动 机 、 液 压 或 气压 活塞 
以 及 其 他 可 以 使 这 些 机 械 装 置 的 连接 部 分 运动 的 元 素 
则 称 之 为 驱动 装置 。 在 本 章 中 ， 我 们 主要 考虑 机 器 人 
机 械 装置 以 及 驱动 装置 的 多 种 多 样 的 设计 ， 正 是 它们 
实现 了 一 整套 可 以 将 电脑 命令 转化 为 千变万化 的 物理 
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运动 的 功能 。 


早期 设计 的 机 器 人 都 具有 一 般 的 运动 能 力 ， 因 为 
设计 者 们 认为 如 果 一 个 机 器 人 可 完成 最 多 样 化 的 任务 
类 型 ,那么 它 可 找到 的 市 场 也 最 广 。 然 而 这 种 过 于 强 
调 市 场 适应 性 的 设计 导致 了 制造 和 使 用 的 高 成 本 。 现 
在 的 机 器 人 更 多 的 是 仅仅 围绕 一 个 特定 系列 的 任务 开 
始 进行 设计 。 

机 器 人 设计 关注 的 是 关节 的 数量 、 外 形 大 小 、 负 
载 能 力 和 末端 执行 器 所 需 的 运动 条 件 。 运 动 结构 的 构 
造 和 术 器 人 的 总 体 大 小 是 由 其 所 要 完成 的 任务 的 需 
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求 、 工 作 空间 以 及 其 本 身 的 再 适应 能 力 决定 的 。 这 些 
特点 都 影响 到 了 末端 执行 器 路 径 控 制 的 精度 ， 而 此 精 
度 在 弧 焊 和 喷漆 机 器 人 的 平滑 运动 的 过 程 中 都 需要 得 
到 保证 。 同 时 ， 它 们 也 决定 了 进行 装配 所 必需 的 完全 
的 定位 能 力 、 进 行 材 料 处 理 所 必需 的 可 重复 能 力 以 及 
进行 精确 的 、 实 时 的 、 基 于 传 感 装置 的 运动 所 必需 的 
高 分 辨 率 和 精确 度 。 

在 进行 机 器 人 系统 设计 时 我 们 所 要 考虑 的 一 个 十 
分 关键 的 问题 就 是 我 们 到 底 想 要 这 个 机 器 人 完成 多 少 
任务 。 这 个 机 器 人 被 设计 具有 的 适应 性 应 该 可 以 顺利 
地 完成 这 一 范围 内 的 任务 。 这 决定 了 这 个 机 器 人 的 机 
械 装 置 拓扑 设计 和 驱动 系统 。 而 几何 形状 、 材 料 、 传 
感 器 的 选择 ， 包 括 电缆 线路 径 的 设计 都 要 基于 这 些 最 
根本 的 决定 因素 。 


3.2 系统 特征 


工作 范围 和 负载 能 力 是 赋予 一 个 机 器 人 各 种 特质 
的 最 主要 的 特征 。 


3.2.1 工作 范围 


机 器 人 工作 范围 的 定义 是 机 右 人 自己 可 以 进行 操 
作 的 空间 ， 其 中 便 包 含 了 工作 空间 的 定义 。 工 作 空 间 
通常 定义 了 机 右 人 的 位 置 和 方向 以 便 其 完成 指定 的 任 
务 ， 而 工作 范围 在 此 基础 上 还 包括 机 器 人 自己 运动 时 
所 占据 的 空间 体积 。 这 个 范围 是 由 关节 的 类 型 、 关 节 
运动 的 区 间 和 连接 它们 的 连 杆 长 度 所 决定 的 。 在 设计 
机 器 人 的 机 械 结 构 时 ， 工 作 范 围 的 大 小 以 及 机 器 人 上 
的 负载 大 小 是 我 们 首要 考虑 的 问题 。 

机 器 人 工作 范围 的 设计 必须 要 考虑 到 机 械 结构 
的 运动 可 能 会 受到 限制 的 部 分 。 这 些 约束 来 源 于 关 
节 运 动 范围 的 有 限 性 、 连 杆 长 度 、 轴 间 夹 角 或 者 这 
些 因素 的 综合 作用 。 一 般 来 说 ， 转 动 关节 机 械 臂 在 
工作 范围 的 中 间 会 比 在 其 极限 位 置 有 更 好 的 工作 效 
果 《〈 见 图 3.1) 。 机 械 臂 的 长 度 和 关节 的 移动 范围 之 
间 应 该 留 出 一 定 的 空 阶 ， 以 便 在 传感器 的 引导 下 形 
成 各 种 各 样 的 移动 路 径 ， 并 且 为 末端 执行 器 或 工具 
的 更 换 提 供 方便 ， 否 则 偏 移 量 和 长 度 的 不 同 将 经 常 
改变 工作 范围 。 
3.2.2 负载 能 力 

作为 机 器 人 最 主要 的 特征 之 一 ， 负 载 能 力 与 速 
度 和 加 速度 有 着 非常 密切 的 关系 。 对 于 装配 机 器 人 


来 说 ， 首 要 任务 是 保证 位 置 精度 ， 将 一 个 简单 的 抓 
取 - 释 放 动 作 循环 的 时 间 减 到 最 小 ， 因 此 机 械 结构 的 





图 3.1 PUMA 560 机 器 人 


加 速度 和 刚度 〈 绪 构 和 驱动 刚度 ) 与 峰值 速度 和 最 
大 负载 能 力 相 比 往往 是 更 为 重要 的 参数 。 而 弧 焊 时 
所 需要 的 是 在 控制 路 径 上 缓慢 的 移动 ; 同时， 速度 
的 细微 变化 和 跟踪 焊接 路 径 的 准确 性 都 十 分 重要 。 
因此 ， 人 们 更 应 当 依 据 一 个 操作 装置 的 有 效 载 荷 特 
性 ， 而 不 是 最 大 载荷 ， 来 进行 操作 装置 的 设计 和 
确定 。 

规定 负载 能 力 时 必须 将 末端 执行 器 的 重力 和 惯 
性 力 列 入 考虑 范围 。 这 些 因素 将 对 腕 关节 、 末 端 执 
行 器 的 设计 和 驱动 部 分 产生 很 大 影响 。 一 般 情况 下 ， 
负载 能 力 在 机 械 臂 加 速度 和 腕 关节 扭矩 的 方面 相对 
其 他 因素 更 加 重要 。 负 载 情况 也 会 影响 到 机 械 臂 静 
态 结构 的 变形 、 电 动机 转 失 的 稳定 性 、 系 统 固 有 频 
率 、 误 减 ， 及 伺服 系统 控制 变量 的 选择 。 这 些 因 素 
都 对 机 华人 是 否 能 够 实现 最 好 的 运行 效果 和 稳定 性 
起 到 重要 作用 。 


运动 骨架 


机 械 臂 的 形状 和 大 小 是 由 其 工作 空间 的 形状 、 布 
局 ,运动 的 精确 程度 ,速度 和 加 速度 及 其 结构 的 需求 
所 共同 决定 的 。 笛 卡 儿 坐标 下 的 机 械 臂 〈 腊 关节 的 
轴 可 旋 或 不 可 旋 ) 拥有 最 简单 的 变形 和 控制 方程 。 
它们 移动 的 〈 直线 运动 的 ) 、 垂 直 的 轴 使 运动 的 规划 
和 计算 变 得 简单 且 相 对 直接 。 因 为 他 们 的 主 运动 轴 没 
有 进行 动力 的 耦合 《在 原始 设置 下 ) ， 所 以 他 们 的 控 
制 方程 也 被 大 大 简化 了 。 具 有 全 部 转动 关节 的 机 械 臂 
通常 更 难以 控制 ， 但 是 他 们 在 给 定 的 工作 空间 中 却 可 
使 结构 更 紧凑 和 高 效 。 一 般 情 况 下 ， 设 计 和 制造 一 个 
转动 关节 比 一 个 长 时 间 运 动 的 移动 关节 更 加 容易 。 相 
比 龙 门 型 机 带 人 ， 具 有 转动 关节 机 械 辟 的 机 器 人 的 工 
作 空 间 能 够 更 加 方便 地 与 经 过 调节 的 直角 坐标 型 机 器 
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构 或 者 任务 执行 的 需要 。 比 如 ， 当 需要 进行 一 个 非常 
精确 的 垂直 直线 的 运动 时 ， 我 们 会 选择 一 个 简单 的 棱 
柱 垂直 关节 轴 而 不 是 两 个 或 三 个 需要 协调 控制 的 转动 
关节 。 

想 要 使 一 个 机 器 人 机 械 臂 的 末端 执行 器 能 够 达 
到 其 工作 空间 中 的 任意 方向 和 位 置 ， 最 少 需要 6 个 
自由 度 。 当 然 ， 大 多 数 简 单 的 或 预 设 好 的 任务 所 需 
的 自由 度 也 可 以 少 于 6 个。 这 是 因为 他 们 可 以 经 过 
精心 的 设计 来 减少 特定 轴 的 运动 ， 或 者 这 项 任务 并 
不 需要 用 到 空间 中 所 有 的 位 置 。 一 个 典型 的 例子 便 
是 垂直 装配 机 器 人 使 用 螺钉 旋 具 时 的 情况 ， 它 仅 需 
要 三 个 自由 度 。 

在 有 些 应 用 中 ,我们 需要 在 多 于 6 个 自由 度 的 情 
况 下 运用 机 械 辟 ， 特 别 是 需要 机 动 性 或 绕 开 一 些 障碍 
物 的 时 候 。 例 如 ， 一 个 管道 外 壁 涂料 维护 机 器 人 不 仅 
需要 棕 制 其 形状 还 需要 控制 末端 执行 器 的 精确 走 位 。 
一 般 来 说 ,添加 自由 度 会 使 循环 时 间 增 长 ， 减 少 负 载 
能 力 并 降低 给 定 的 机 械 臂 结构 和 驱动 系统 的 精确 
程度 。 


3.3 运动 学 与 动力 学 


机 器 人 的 动力 系统 可 以 分 为 两 个 部 分 : 一 部 分 
依赖 于 其 机 械 结 构 的 几何 特征 以 及 作用 在 其 结构 上 
的 力 ， 反 映 了 机 器 人 的 运动 特质 ， 称 为 运动 学 ; 另 
一 部 分 则 通过 力 对 系统 产生 作用 ， 称 为 动力 学 。 动 
力学 中 的 一 条 基本 法 则 告诉 我 们 : 运动 机 器 人 能 量 
的 改变 和 外 力 在 其 上 做 的 功 之 间 的 差异 在 运动 轨迹 
的 细小 变化 过 程 中 保持 不 变 。 这 就 是 虚 功 和 虚 状 态 
原理 ， 它 要 求 在 所 有 的 虚 位 移 上 功 与 能 量 的 变化 相 
Baye a 

由 于 像 机 器 人 这 样 的 机 械 都 尽量 设计 得 使 能 量 损 
失 最 小 化 ， 其 能 量 损失 一 般 源 于 关节 的 摩擦 和 材料 的 
疲劳 ， 所 以 我 们 可 以 认为 能 量 的 变化 量 是 很 小 的 。 这 
就 意味 着 驱动 装置 所 输入 的 功 几 乎 能 够 全 部 转化 为 输 
出 的 力 所 做 的 功 。 

如 果 在 一 段 微小 的 时 间 里 考虑 这 种 关系 ， 我 们 可 
以 得 到 输入 功 的 速率 ， 即 功率 ， 近 似 等 于 相应 的 输出 
功率 。 因 为 功率 等 于 力 乘 以 速度 ,我们 便 得 到 了 最 基 
本 的 关系 : 输入 力 与 输出 力 的 比值 和 输入 速度 与 输出 
速度 的 比值 互 为 倒数 。 另 一 种 表述 方式 为 ， 对 于 理想 
的 机 械 ， 机 械 增益 等 于 其 速度 比值 的 倒数 。 


3.3.1 机 如 人 拓扑 


铵 接 的 或 可 滑 移 的 关节 与 连 杆 组 成 链 状 结构 ， 一 
系列 这 样 的 链 状 结构 又 组 成 了 机 器 人 的 运动 骨架 。 这 
种 骨架 一 般 具 有 两 种 基本 形式 .如果 是 由 单一 连续 的 
链 状 结构 组 成 ， 就 定义 为 串联 机 器 人 ( 见 图 3.1); 
而 如 果 是 多 个 连续 的 链 状 结构 共同 支持 同一 个 终端 控 
制 装置 ， 如 图 3. 2 所 示 ， 我 们 称 之 为 并 联机 器 人 。 机 
器 人 经 过 设计 可 以 实现 并 联 工作 ， 比 如 一 个 行走 机 器 
人 的 腿 部 (OLA 3.3 和 图 3.4)?! 和 一 个 机 器 人 手 的 
多 个 手指 (WA 3.5 ~ 3.7)", 





图 3.2 一 个 并 联机 器 人 ， 可 以 有 多 达 6 个 串联 链 
将 一 个 末端 平台 连接 到 基 座 





图 3.3 有 自 适应 能 力 的 悬挂 式 车 型 行走 机 器 人 


机 器 人 的 末端 执行 器 是 与 环境 进行 交互 的 首选 工 
具 ， 而 它 的 定位 和 定向 则 需要 依赖 于 机 顺 人 的 运动 骨 
架 。 对 于 一 个 普通 的 串联 机 器 人 来 说 ， 一 个 具有 六 关 
节 的 链 状 结构 便 可 以 提供 对 其 终端 装置 的 全 部 控制 。 
而 对 于 一 个 普通 的 并 联机 器 人 ，6 个 关节 往往 不 够 ， 
同时 六 个 驱动 装置 还 需要 通过 与 关节 不 同 的 关联 方式 
来 实现 对 于 其 终端 装置 运动 的 控制 。 
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图 3.4 具有 自 适 应 能 力 的 悬挂 式 车 型 行走 机 器 人 


y 
le 


3.5 Salisbury 三 指 机 器 人 手 和 其 电缆 结构 连接 平台 与 基底 








Salisbury 手 作 为 PUMA 机 器 人 的 末端 执行 器 
(图 上 未 展示 驱动 系统 ) 





图 3.7 Salisbury 三 指 手 在 抓 取 物体 时 的 照片 


3. 3.2 运动 学 方程 

通过 其 运动 学 方程 ， 机 絮 人 可 以 用 它 自 己 各 关节 
的 详细 参数 ， 比 如 旋转 关节 转 过 的 角度 和 滑动 关节 移 
动 的 距离 ， 来 定义 一 个 机 械 任意 组 成 部 分 的 位 置 。 要 
做 到 这 点 ， 我 们 需要 用 一 系列 的 线条 来 描述 机 器 人 。 
这 些 线条 代表 着 相互 等 价 的 旋转 或 者 棱 形 关节 的 2, 
轴 和 公 垂 线 x,， 而 后 两 者 则 组 成 了 整个 链 状 结构 的 运 
动 骨架 〈 见 图 3.2) 。 这 样 的 结构 可 以 使 机 器 人 的 每 
个 连 杆 的 详细 位 置信 息 通过 下 面 的 矩阵 方程 与 基准 产 
FKZ: 

T =Z(0,, d,)X(a,, a,)Z(0,, d)... X 

X(Qn-1s am-1)Z( 0n, dn) (3,1) 
这 就 是 链 状 结构 的 运动 方程 ”5 (参见 第 1 章 式 
(1.44) ) 。 由 所 有 的 关 下 参数 所 确定 的 所 有 末端 执行 
器 所 能 到 达 的 位 置 7 的 集合 被 称 为 机 需 人 的 工作 
空间 。 

Z(0,, d) AXo, a) 都 为 4x4 的 矩阵 ， 分 
别 定 义 了 绕 着 和 沿 着 关节 轴 z 与 % 的 旋转 位 移 
BON, FCW SAR a ，a 确 定 了 链 中 连 杆 的 维度 。 
6 代表 旋转 关节 的 角度 变量 ,而 d MERE KI A 
位 置 变化 量 。 末 端 执行 器 上 一 点 ”P 的 轨迹 'p(i) 可 
以 通过 关节 的 轨迹 获得 ， 满 足 如 下 公式 : 

‘p(t) =T(q(t))"p (3,2) 
AP, g(t) = (q(t)，... ，qm(t)) ， GH ORE d; 
则 依照 具体 关节 而 定 。 

如 果 末 端 执行 器 与 基准 框架 是 通过 多 于 一 个 的 串 
联 链 状 结构 连接 的 〈 见 图 3.2) ， 那 么 对 于 每 一 个 链 
结构 来 说 我 们 都 有 一 套 运动 方程 ， 

T=BT(q,)E,, j=1,...,n (3.3) 
式 中 ，B, 确定 了 第 j 个 链 的 基 坐 标 ; E, 定义 了 它 与 
末端 执行 器 的 连接 人 位置。 那些 能 够 同时 满足 所 有 这 
些 方程 的 了 组 成 的 集合 就 是 末端 执行 器 的 工作 空 
间 。 这 给 关节 的 变量 增加 了 约束 ， 这 些 约束 必须 先 
被 确定 下 来 才能 完整 地 定义 末端 执行 器 的 工作 


空间 。 
3.3.3 构 型 空间 


一 个 机 器 人 的 构 型 空间 指 的 是 可 以 使 用 的 关节 参 
数值 的 范围 ， 而 运动 方程 将 它 与 末端 执行 器 的 工作 空 
间 联 系 在 了 一 起 。 这 个 构 型 空间 是 设计 机 器 人 躲避 障 
碍 路 径 的 基本 工具 “”" 。 虽 然 组 成 机 器 人 的 链 状 结构 
中 的 任何 一 个 连 杆 都 有 可 能 与 障碍 物 发 生 碰 撞 ， 但 
是 只 有 末端 执行 器 是 设计 来 靠近 这 些 障 碍 物 并 实现 
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其 功能 的 ， 这 些 障 碍 物 如 支撑 机 器 人 的 桌子 和 所 要 
抓 取 工件 的 夹具 等 。 由 于 障碍 物 的 存在 ， 工 作 空 间 
中 出 现 了 一 些 禁止 到 达 的 位 置 和 方向 。 与 其 对 应 ， 
机 器 人 的 构 型 空间 中 也 出 现 了 不 能 实现 的 关节 夹 角 。 
所 以 ， 机 器 人 工作 路 径 的 设计 者 就 必须 要 在 除了 这 
些 关 节 障 碍 的 其 他 自由 空间 中 来 寻找 一 条 能 够 到 达 
目的 地 的 路 径 。 


速度 比 
机 融 人 的 速度 比 将 末端 执行 器 上 一 点 'p 的 速 


度 'P 与 关节 的 速率 g = (gq ，... ，9。) 建立 了 联 
系 ， 方程 为 : 


3.3.4 


F 


p =v +@x("p-d) (3.4) 
式 中 ,d 为 参考 点 的 位 置 ; v 为 参考 点 的 速度 ;w 是 末 
Dia TAT at HY FA TR BE 

向 量 v 与 w 可 通过 下 列 方程 与 关节 速率 q, 建立 
联系 : 


ov ðv ðv j 
vy | 841 ðq Bg |}. 
ad” ae aw, aw || | 77 
89, 969， T hn 
或 者 
v=Jq (3. 6) 


Arh , RBH J 称 为 雅 可 比 矩 阵 。 它 作为 速度 比 矩 
阵 ,建立 起 了 末端 执行 器 速度 与 输入 的 关节 旋转 速率 
之 间 的 关系 49] 。 


3.3.5 机械 增益 


如 果 末端 执行 器 在 点 "p 上 作用 上 的 力 ,那么 输出 
功率 为 : 
ro Spe [92 4 2 Ry ay |e 
Pa “TP = aS ie + x ("p d) |a, 
(3.7) 
如 果 关 节 S, 处 有 驱动 装置 , 则 上 述 和 式 中 的 每 一 项 都 
是 其 中 某 个 驱动 装置 提供 的 功率 在 总 输出 功率 中 所 占 
的 那 部 分 。 
关节 S 处 输入 的 功率 是 转 矩 了 与 角速度 g 的 
乘积 呈 19,。 对 每 一 个 关节 运用 虚 功 原理 ,我 们 可 以 
得 到 : 
t =f. 24 (p-d) xf 22, j=1,,m. 
ðq; ðq; 
(3.8) 
我 们 可 以 利用 此 公式 在 参考 点 4& 引 入 力矩 矢量 f= (Sf, 


( 卫 -d) xf)", 
方程 式 (3.8) 可 变形 为 矩阵 形式 : 
T=J'f (3.9) 
AP, JAK 3.5) 中 定义 过 的 雅 可 比 和 矩阵 。 对 于 
一 个 具有 六 关节 的 链 结构 来 说 ， 运 用 这 个 方程 可 以 解 
得 输出 力矩 矢量 人 f， 
f=(J') T (3.10) 
因此 , FRB RE LKAA FE LS B58 SE FE 
HEFE RE KII AE BE 


3.4 串联 机 器 人 


”串联 机 器 人 是 以 底座 为 开始 ， 以 末端 执 行 器 为 结 
束 的 一 系列 连 杆 和 关节 ， 如 图 3. 8 所 示 。 机 器 人 的 连 
杆 和 关节 常常 被 设计 成 可 以 提供 独立 平移 和 定 方 向 的 
结构 。 通 常情 况 下 ， 前 3 个 关节 一 般 用 来 在 空间 定位 
一 个 参考 点 ， 后 3 个 关节 用 来 组 成 可 以 确定 这 个 点 附 
近 的 末端 执行 器 方向 的 腕 关节 “”"。 这 个 参考 点 被 
叫做 胸 坐 标 中 心 。 腕 坐标 中 心 所 能 够 到 达 的 空间 被 叫 
做 机 需 人 的 可 达 工 作 区 。 到 达 这 些 点 且 可 旋转 的 空间 
称 为 灵巧 工作 空间 。 





图 3.8 Salisbury 的 一 根 手指 是 一 个 串联 机 器 人 


一 个 机 器 人 往往 设计 成 它 的 可 达 工 作 区 是 对 称 
的 。 从 这 个 角度 看 ， 有 三 种 基本 形状 : 和 矩形、 圆柱 形 
和 球形 。 甜 形 工作 区 是 由 3 个 相互 垂直 的 移动 (P) 
关 广 组 成 。 这 些 关 节点 可 构成 所 谓 的 笛 卡 儿 型 机 器 人 
的 PPPS 链 ， 其 中 S 指 的 是 一 个 允许 相对 于 其 中 心 点 
所 有 方向 转动 的 球形 匀 链 的 腕 关节 。 旋 转 的 底座 和 两 
个 移动 关节 点 可 构成 一 个 具有 圆柱 工作 区 的 CPS 链 ， 
其 中 C 指 的 是 共 轴 的 旋转 (R) ARB (P) 关节 
点 。P 了 关节 可 被 一 个 作为 肘 关 节 的 、 出 提供 相同 径 向 
运动 的 转动 (R) 关节 所 替代 。 最 后 ， 两 个 相互 垂直 
的 旋转 关节 在 机 器 人 的 底座 上 组 成 一 个 形 关节 ， 这 
个 关节 可 支持 围绕 横向 和 纵向 转轴 的 旋转 。 径 向 移动 
既 可 以 由 P 了 关节 点 提供 也 可 以 由 作为 和 肘 的 R 关节 点 
提供 ， 它 便 构成 了 一 个 具有 球形 工作 空间 的 TPS 链 
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BY TRS 链 。 

工作 区 间 的 完全 对 称 是 很 少 能 实现 的 ， 因 为 
关节 的 轴线 往往 需要 为 避免 连 杆 的 碰撞 而 偏 置 ， 
而 且 还 存在 与 工作 区 间 扭 曲 变形 相关 的 关节 运动 
限制 。 


3.4.1 设计 优化 

另 一 种 设计 机 器 人 的 方法 是 用 机 器 人 工作 区 间 
的 直接 规格 参数 作为 系统 的 末端 执行 器 的 位 置 集 合 ， 
我 们 称 之 为 任务 空间 ““'… 。 一 - 般 串联 机 械 辟 对 于 
其 上 的 5 个 连 杆 的 每 个 连 杜 就 有 两 个 设计 参数 ， 连 
FPS GS, OS 个 连 杆 中 ， 每 个 都 具有 4 个 可 
以 指示 机 器 人 底座 和 其 末端 执行 器 上 工件 位 置 的 参 
数 ， 所 以 总 共有 18 个 设计 变量 。 连 杆 参数 往往 都 被 
给 定 了 ， 以 保证 工作 链 有 球形 的 腕 和 特定 的 工作 空 
间 。 设 计 目 标 通常 是 确定 工作 空间 的 体积 并 且 指 出 
底座 和 工件 的 框架 ， 以 便于 工作 空间 能 包含 特定 的 
任务 空间 。 

任务 空间 一 般 由 4 x4 ERE D, i=1,，... hE 
义 。 利 用 迭代 的 方式 ， 通 过 选择 一 个 设计 ， 并 用 联合 
的 运动 学 方程 T(q) 来 求 得 目标 方程 


k 
Kr) = ¥ IDT" (4) | (3.11) 


中 相关 位 移 的 解 。 最 优化 技术 可 以 得 到 使 目标 函数 最 
小 化 的 设计 参数 矢量 r。 

这 种 优化 取决 于 末端 执行 器 和 理想 工作 空间 之 
fa] 4 BE BS Be ae AY EL, Park!" Martinez 和 Duf- 
fy? 19) ，Zefra 9! | lin, Burdick? 等 人 已 经 告诉 
我 们 没有 距离 度量 是 坐标 的 结构 不 变量 。 这 个 也 就 
是 说 ， 除 非 这 一 目标 函数 可 以 被 化 为 零 ， 使 工作 区 
完全 包含 任务 空间 ， 那 么 最 终 的 结果 将 并 不 能 使 设 
计 与 坐标 的 选择 相互 独立 ， 也 因此 不 能 被 称 为 几何 
的 设计 。 


3.4.2 速度 比 


依据 式 (3.5) ， 六 轴 机 器 人 是 一 个 6 x 6 的 雅 
可 比 和 矩阵 ,一 个 由 速度 比 构 成 的 阵列 ， 此 速度 比 的 
意义 便 在 于 将 腕 中 心 速度 ov 以 及 末端 执行 希 角 速度 
wo 与 每 个 关节 的 速度 联系 起 来 。 方程 (3.9) 表明 ， 
从 每 个 驱动 器 提供 的 转 窍 的 角度 来 看 ， 这 个 雅 可 比 
矩阵 定义 了 施加 在 腕 中 心 的 转 矩 矢量 f。 机 器 人 的 连 
杆 参 数 可 以 用 来 确定 一 个 具有 特定 属性 的 雅 可 比 
EE, 

一 个 机 器 人 的 驱动 转 矩 的 平方 和 通常 被 用 来 作为 





结果 的 一 个 测量 标准 量 *” MR (3.9) 我 们 
得 到 

T'T=fJJ'f (3.12) 
AP, EJI 是正 方形 的 正定 和 矩阵。 因此， 它 可 
以 被 看 成 是 在 六 维 空间 内 对 超 椭 球体 的 定义 。 这 个 
椭 球 体 的 半径 是 这 个 雅 可 比 和 矩阵 特征 值 的 绝对 值 的 
相反 数 。 这 些 特征 值 可 以 被 看 做 确定 每 个 关节 速度 
与 放大 量 的 模 态 速度 比 。 其 倒数 是 相关 模 态 的 机 械 
增益 ， 所 以 这 个 椭 球 形状 说 明了 机 器 人 的 力 的 增益 
性 能 。 

最 大 特征 值 与 最 小 特征 值 的 比率 ， 即 所 谓 的 条 件 
数 ， 给 出 了 关于 椭 球 的 各 向 异性 或 失 贺 的 尺度 。 一 个 
球体 的 条 件数 为 1， 称 之 为 各 向 同性 。 当 一 个 机 器 人 
的 末端 执行 器 所 处 的 位 置 所 对 应 的 雅 可 比 和 矩阵 各 回 同 
性 时 ， 就 不 存在 速度 比率 的 放大 或 者 机 械 增益 。 因 为 
误差 是 不 会 被 扩大 的 ， 所 以 这 个 模型 被 认为 可 以 在 输 
人 和 输出 间 提 供 很 好 的 耦合 。 因 此 ， 条 件数 在 机 器 人 
设计 中 也 被 作为 一 个 评价 准则 。 

这 种 情况 建立 在 机 器 人 的 基本 设计 工作 区 间 包 
含 了 其 任务 空间 的 假设 之 上 。 参 数 优 化 确定 了 内 部 
的 连 杆 参数 ， 这 些 参数 可 以 产生 一 个 具有 我 们 所 期 
望 的 属性 的 雅 可 比 和 矩阵 。 正 如 我 们 的 设计 与 理想 工 
作 区 间 之 间 的 差距 的 最 小 化 过 程 中 ， 基 于 雅 可 比 挑 
阵 的 优化 也 取决 于 一 个 能 够 避免 坐标 相关 性 的 公式 
化 的 过 程 。 


3.5 HEILA 


有 两 个 或 两 个 以 上 串联 机 器 人 来 支持 末端 执行 器 
的 机 器 人 系统 被 称 作 并 联机 器 人 。 例 如 ， 自 适应 基 架 
车 辆 (ASV) (了 见 图 3.9)， 是 一 种 由 并 联 驱 动 装置 驱 
动 的 缩放 装置 。 

并 联机 器 人 的 每 一 个 支撑 腿 可 有 多 达 6 个 自由 
度 ， 然 而 在 整个 系统 中 一 般 只 有 6 个 关节 受到 驱动 。 
一 个 很 好 的 例子 就 是 Stewart 平台 ， 它 由 6 个 TPS 机 
器 人 组 成 ， 而 在 这 些 TPS PLABA ME PEE RA P 
关节 是 主动 驱动 的 。 

这 TPS 腿 的 运动 学 方程 是 

T=BT(0)E,, j=1,...,6 (3.13) 
式 中 , B 指 的 是 腿 的 底座 ; E 则 定义 了 底座 与 末端 
执行 器 连接 的 位 置 。 能 同时 满足 所 有 这 些 方程 的 位 置 
7 的 集合 便 是 并 联机 器 人 的 工作 区 。 

往往 并 联机 器 人 的 一 个 工作 链 可 以 被 几何 约束 所 
定义 ， 例 如 ， 如 果 位 置 了 满足 方程 
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图 3.9 ASV 步行 机 器 的 一 条 腿 就 是 一 个 并 联机 器 人 


(Tx; -p;) + (Tx, -P;) =p; (3.14) 

那么 了 就 是 属于 第 7 个 TPS 支撑 腿 的 工作 区 。 因 

Ap; 的 长 度 受到 了 驱动 关节 的 控制 ， 所 以 这 个 方程 

EN TEMAT p, 到 平台 上 连接 点 的 距离 。 在 这 种 

情况 下 ， 工 作 区 就 是 满足 所 有 6 个 方程 的 位 置 了 的 集 
合 ， 同 时 ， 每 个 腿 都 具有 这 样 一 个 工作 区 。 





3.5.1 工作 区 间 


并 联机 器 人 的 工作 区 间 是 单个 支撑 腿 的 工作 区 间 
的 交集 。 然 而 ， 这 并 不 是 简单 地 将 可 达 工 作 区 与 灵巧 
工作 区 分 别 独立 相交 。 在 并 联机 器 人 中 ， 这 些 工 作 区 
都 是 密切 结合 的 。 这 些 灵巧 工作 区 一 般 在 可 达 工 作 区 
中 心 附近 最 大 ， 并 且 随 着 参考 点 向 可 达 工 作 区 的 边缘 
移动 而 逐渐 缩小 。 通 过 支撑 腿 的 设计 ， 在 运动 对 称 性 
方面 产生 了 一 个 新 的 关注 焦点 ， 同 时 经 过 很 多 创新 并 
联 设计 ， 这 个 焦点 已 经 成 为 一 个 重要 的 设计 工 
ALO | 模拟 系统 是 利用 设计 参数 来 评价 机 器 人 的 
工作 区 间 的 。 

另 一 种 方法 是 直接 指定 工作 区 间 中 的 位 置 和 方 
向 ,这 些 位 置 和 方向 均 是 确定 腿 的 限制 的 代数 方程 中 
的 参数 ， 而 这 些 腿 的 限制 又 决定 了 设计 参数 ”” 。 
这 称 为 运动 合成 ， 同 时 产生 出 了 不 对 称 并 联机 器 人 ， 
但 是 此 机 器 人 具有 指定 的 可 达 工 作 区 和 灵巧 工作 区 ， 
参见 MeCarthy! >”! 。 


3.5.2 ”机械 增益 


通过 考虑 单个 支撑 腿 的 雅 可 比 和 矩阵 ， 我 们 可 以 得 
到 并 联机 器 人 的 力 的 增益 特性 。 利 用 由 6 个 向 量 组 成 
的 Vv=(v ，w) 来 定义 平台 的 线 速度 和 角速度 ， 从 每 
个 支撑 腿 的 运动 学 方程 可 以 得 到 

SJP: =J, Pa =" =ps (3. 15) 

在 这 里 假设 此 平台 有 6 个 支撑 腿 , 但 也 可 以 更 
少 ， 比 如 当 机 械 手 的 手指 抓 住 一 个 物体 时 。 

通过 虚 功 原理 可 得 到 由 每 个 链 提供 给 平台 的 力 

f=(J") G, j=1,..., 6. (3.16) 

在 系统 中 只 有 6 个 驱动 关节 ， 所 以 我 们 把 这 些 相 
关 的 力矩 都 列 写 到 矢量 = (T, =, T) 中 去 。 如 
RE EET =1 且 富余 力矩 为 0 的 条 件 下 通过 式 
(3.16) 得 到 的 力 -力矩 拓 量 , 那么 最 终 作 用 在 平台 
上 的 力 -力矩 w 为 

w=(f f, f )T (3.17) 

或 者 

w=IT (3.18) 

RRR T 的 元 素 决定 了 每 个 驱动 关节 的 机 械 
增益 。 在 Stewart 平台 的 例子 中 ， 和 矩阵 中 的 各 列 便 是 
沿 着 各 条 腿 线条 的 Pliicker 坐标 。 

利用 虚 功 原理 可 以 得 到 用 关节 速率 表达 的 平台 速 
度 函 数 : 

TT'v=p (3. 19) 

因此 丁 的 道 矩 阵 确定 了 驱动 关节 和 末端 驱动 装 
置 间 的 速度 比 。 同 样 的 方程 可 以 通过 几何 约束 方程 
(3.14) 的 导数 的 计算 得 到 ， 并 且 也 是 并 联机 器 人 系 
统 的 雅 可 比 和 矩阵 。 

这 个 雅 可 比 和 矩阵 也 被 应 用 在 参数 优化 算法 中 ， 
以 设计 出 具有 各 向 同性 机 械 增益 的 并 联机 器 人 。 行列 
式 | TT “| 的 平方 根 可 测量 由 列 向 量 f 限定 的 六 维 体 
积 。 这 个 体积 与 其 在 工作 区 间 中 的 最 大 值 的 比值 的 分 
布 也 被 用 作 衡 量 机 器 人 的 整体 性 能 ““”' 。 通 过 测量 
可 用 的 最 大 关节 扭矩 和 最 大 的 期 望 力 和 力 殷 ， 一 个 相 
似 的 性 能 衡量 方式 将 雅 可 比 和 矩阵 标准 化 ， 然 后 再 寻找 
一 个 各 向 同性 的 设计 。 


3. 5.3 特殊 并 联机 器 人 


另 一 种 设计 并 联机 器 人 的 方法 是 将 它 的 功能 分 成 
定位 和 移动 两 部 分 。Tsai、 Joshi]. Jin 和 Yang!**!! 
调查 设计 了 一 类 只 产生 移动 的 并 联 链 。Kong 和 Gos- 
selin 和 Hess- Coelho “做 了 同样 的 工作 ,设计 了 能 
在 空间 中 提供 旋转 运动 的 并 联 链 。 
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3.6 机械 结构 


为 了 动态 建 模 ， 机 器 人 的 连 杆 通常 被 认为 是 刚性 
的 ， 但 是 机 器 人 并 不 是 刚性 结构 。 像 所 有 的 结构 一 
样 ， 机 器 人 将 在 如 自身 重力 和 载荷 重力 等 在 加 载荷 的 
作用 下 弯曲 ， 见 图 3. 10 和 图 3. 11 。 这 种 变形 是 程度 
的 问题 。 导 致 连 杆 弯曲 需要 的 力 越 大 ， 机 器 人 就 越 像 
一 个 由 刚性 结构 构成 的 整体 。 刚 性 机 器 人 的 连 杆 被 设 
计 得 具有 一 定 的 硬度 ， 以 实现 负载 所 造成 的 弯曲 小 于 
其 所 需 完成 的 各 种 任务 对 精确 定位 的 要 求 。 这 样 就 保 
证 了 动态 建 模 和 控制 算法 不 需要 考虑 连 杆 的 变形 。 大 
多 数 商 用 机 器 人 的 手臂 都 是 这 种 类 型 的 〈 见 参考 文 
献 [3.44] ) 。 








图 3. 11 DeLaval VMS 的 挤 奶 机 器 人 


通过 增加 控制 算法 ， 使 其 包括 由 重力 产生 的 连 杆 
变形 的 模型 ， 我 们 可 以 改进 一 个 刚性 机 器 人 的 定位 精 
度 。 我 们 还 可 以 使 用 压力 传感器 来 衡量 载荷 和 挠 度 。 
这 些 半 刚性 机 器 人 都 假定 了 小 的 结构 变形 与 已 知 的 负 
载 呈 线性 相关 的 关系 。 

柔性 机 器 人 要 求 动态 模型 包括 各 个 关节 由 重力 负 
载 所 造成 的 变形 ， 以 及 由 加 速度 产生 的 惯性 力 带 来 的 
载 何 ， 即 所 谓 的 惯性 负载 。 机 器 人 控制 算法 必须 同时 
控制 系统 的 振动 以 及 其 总 体 运动 。 振 动 的 控制 甚至 在 
刚性 机 器 人 中 也 是 必需 的 ， 以 实现 高 速 和 对 大 型 有 效 
载荷 的 操纵 。 

连 杆 

工业 机 右 人 所 关注 的 重点 是 在 弯曲 和 扭转 时 的 连 
杆 刚度 。 为 了 提供 这 种 刚度 ， 机 器 人 的 连 杆 常设 计 成 
Rese (Aso) 的 结构 。 单 体 结构 拥有 低 的 质量 
或 者 高 的 强度 -质量 比 ， 但 是 更 加 昂贵 ， 也 较 难 制造 。 
铸造 、 银 造 或 加 工 梁 的 连 杆 往往 具有 更 低 的 成 本 ， 见 
Juvinall 和 Marshek'* “*! 和 Sigley 和 Mischke!* “7! 。 

另 一 个 重要 考虑 是 连 杆 结构 是 否 包 括 用 螺栓 、 焊 
接 或 粘 合 剂 连接 的 组 装 件 ， 包 括 铸 件 ， 机 械 加 工件 以 
及 制造 件 等 。 螺 钉 和 螺栓 连接 看 起 来 似乎 简单 ， 价 格 
低廉 ， 易 于 维护 ， 但 即使 在 制造 过 程 中 都 会 出 现 的 不 
可 避免 的 连 杆 变形 给 这 个 由 多 种 零件 组 装 而 成 的 装配 
件 引 入 了 塑性 变形 ， 这 些 变 形 会 造成 机 器 人 尺寸 和 功 
能 的 变化 。 而 焊接 与 适 造 结构 对 于 塑性 变形 和 廊 后 形 
变 都 更 加 不 敏感 ， 虽 然 许 多 情况 下 ， 它 们 还 要 二 级 加 
工 ， 如 去 除 热 应 力 和 精 加 工 。 

铸件 最 低 的 实际 壁 厚 或 网 格 厚度 可 能 会 大 于 保证 
刚度 所 需 的 厚度 。 薄 壁 可 以 通过 薄皮 结构 ( 单 体 结 
构 ) 来 实现 ,但 是 这 种 优势 可 能 被 淤 在 凹 痕 、 了 永久 
变形 和 轻微 碰撞 的 损坏 所 抵消 。 因 此 ， 当 选择 机 器 人 
的 机 构 和 制造 细节 时 ， 必 须 考虑 性 能 要 求 。 

特种 实用 材料 和 几何 学 都 被 用 于 减少 连接 结构 的 
质量 ， 从 而 也 减少 了 与 之 直接 相关 的 重力 和 惯性 载 
和 荷 。 由 镁 或 铝 合金 构成 的 横 截 面 恒定 的 冲压 件 对 于 实 
现 直线 运动 的 结构 来 说 非常 方便 。 对 于 要 求 高 加 速度 
的 机 器 人 【〔 喷 涂 机 器 人 ) ， 碳 和 玻璃 纤维 合成 物 使 其 
轻 量 化 。 热 塑性 塑料 提供 了 廉价 的 连 杆 结构 ， 虽 然 它 
的 负载 能 力 会 有 所 降低 。 不 锈 钢 经 常 被 用 于 提供 医疗 
和 饮食 服务 的 机 器 人 。 因 为 旋转 的 关节 产生 的 线 加 速 
随 着 其 与 轴 的 距离 的 增加 而 增加 ， 所 以 通过 设计 ， 我 
们 常常 要 减 小 那些 与 这 种 关节 相连 的 连 杆 的 横断 面积 
和 壁 厚 ， 从 而 减少 相关 的 惯性 负载 。 


3.6.1 
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3.6.2 关节 

对 大 多 数 机 器 人 而 言 ， 关 节 只 可 以 旋转 或 者 平 
移 ， 对 应 的 ， 这 两 种 关节 被 定义 为 旋转 关节 和 移动 关 
六 。 其 他 可 用 的 关节 有 球 槽 接合 的 或 者 球形 的 关节 ， 
还 有 胡 克 型 通用 关节 。 

包含 驱动 绒 和 位 置 传感器 的 关节 结构 的 综合 机 械 
结构 是 结构 灵活 性 的 来 源 。 关 节 承 载 区 域 的 变形 可 以 
减少 轴 和 齿轮 的 预 载荷 ， 允 许 间隙 和 空转 ， 也 就 减少 
了 了 精度。 结构 的 灵活 性 也 可 以 影响 齿轮 的 中 心 距离 ， 
引起 力 和 转 矩 ， 同 时 导致 相关 的 变形 ， 如 粘 合 、 墙 塞 
以 及 磨损 。 


3.7 KDA 


一 个 机 器 人 关节 至 少 由 四 个 主要 部 分 构成 ， 
关节 轴 、 了 驱动 器 、 传 动 系统 以 及 状态 传感器 ( 通 
常 作为 位 置 反 馈 ,， 但 是 速度 传感器 、 力 传感器 也 
是 常见 的 )。 

对 于 最 大 加 速度 小 于 0. 5 倍 重力 加 速度 的 低 性 能 
操作 器 ， 系 统 惯 性 并 没有 重力 及 其 转 矩 重要 。 这 意味 
着 驱动 器 可 以 放置 在 关节 附近 ， 它 们 的 悬浮 质量 补偿 
了 平衡 质量 、 弹 力 和 气压 。 

对 于 最 大 加 速度 达到 甚至 超过 3 ~10 个 重力 加 速 
度 的 高 性 能 机 器 人 ， 惯 性 质量 的 最 小 化 就 非常 重要 
了 。 为 了 减 小 惯性 质量 ， 驱 动 器 被 放置 在 系列 操作 器 
的 第 一 个 关节 轴 附 近 ， 并 且 通 过 连 杆 、 带 、 绳 索 或 者 
传动 装置 来 驱动 关节 。 

更 长 的 传动 距离 虽然 可 以 减少 质量 、 重 力 力 第 和 
惯性 ,但 是 也 引入 了 乒 度 ， 从 而 降低 了 系统 的 刚度 。 
每 个 关节 的 驱动 器 位 置 和 传动 设计 与 重力 、 惯 性 、 刚 
度 和 复杂 性 是 两 组 此 消 彼 长 的 矛盾 因素 ， 需 要 我 们 在 
其 中 做 出 折衷 的 选择 。 这 个 选择 就 决定 了 操作 器 的 主 
要 物理 特征 。 

举例 说 明 ， 例 如 Adept 1 综合 机 器 人 ， 其 有 四 个 
自由 度 ， 每 个 都 拥有 不 同 的 结构 。 第 一 个 轴 是 由 电 
动机 直接 驱动 ， 第 二 个 轴 由 传动 带 条 驱动 ， 第 三 个 
由 传动 带 驱动 ， 最 后 一 个 由 直线 型 的 滚珠 丝 杠 驱动 。 
关于 各 种 有 用 的 关节 操作 器 ， 请 参看 Sclater 和 Chi- 


. [3.48 
ronis! ] 。 


3.7.1 关节 轴 结 构 


1, 旋转 轴 
旋转 关节 是 被 设计 用 来 实现 纯 旋转 。 评 价 一 个 旋 


转 关 节 最 重要 的 指标 是 它 的 刚度 或 者 说 是 抵抗 其 他 干 
扰 运 动 的 能 力 。 在 刚度 设计 中 所 应 考虑 的 关键 因素 有 
轴 的 直径 、 误 差 和 间隙 ， 轴 承 的 支撑 结构 ， 以 及 在 梁 
上 加 载 合适 的 预 载荷 。 轴 的 直径 和 轴承 的 尺寸 不 总 是 
以 承载 能 力 为 基础 的 。 实 际 上 ， 它 们 经 常 依据 刚性 的 
支撑 结构 而 进行 选择 ， 并 且 他 们 还 需要 具有 一 个 足够 
大 的 可 以 保证 线 缆 穿 过 的 管道 ， 甚 至 - -个 其 他 单元 的 


“控制 元 件 通过 的 孔洞 。 因 为 关节 轴 经 常 传递 转 垂 ， 所 


以 它 和 它 的 支撑 结构 必须 被 设计 用 来 同时 承受 弯曲 和 
扭转 。PUMA 机 器 人 的 第 一 个 轴 就 是 一 个 有 大 直径 管 
状 构造 的 关节 的 例子 。 

选择 一 个 旋转 轴 的 支撑 结构 是 保证 刚度 的 一 个 重 
要 因素 。 支 撑 托 架 的 排列 方式 和 构造 必须 把 制造 的 偏 
差 、 热 膨胀 以 及 轴承 预 紧 力 考虑 在 内 。 通 过 减少 轴承 
径 向 和 轴 向 的 运动 ， 角 接触 轴承 或 圆锥 滚 子 轴承 的 轴 
向 预 紧 力 提 高 了 系统 精确 度 和 刚度 。 预 载荷 可 以 通过 
选择 性 的 装配 、 弹 性 的 元 件 、 垫 片 、 热 圈 、 四 点 接触 
轴承 、 双 联 式 轴承 排列 、 或 者 紧 的 制造 配合 公差 来 
获得 。 

2. 移动 关节 

移动 关节 有 两 种 基本 类 型 ， 单 级 型 和 伸缩 型 。 单 
级 型 关节 由 一 个 可 沿 另外 一 个 固定 表面 移动 的 表面 组 
成 。 伸 缩 型 关节 本 质 上 是 由 单 级 型 关节 向 套 或 组 合成 
的 。 单 级 型 关节 具有 结构 简单 和 高 刚度 的 优点 ， 而 伸 
缩 型 关节 的 主要 优点 是 它 的 连结 紧凑 ， 并 且 有 大 的 伸 
缩 比 。 对 于 一 些 动作 来 说 ， 伸 缩 型 关节 有 更 小 的 惯 
性 ， 因 为 其 关节 的 某 些 部 分 可 能 没有 移动 或 者 以 减 小 
的 加 速度 移动 。 

移动 关节 中 轴承 的 主要 的 功能 是 促进 其 在 某 一 方 
向 上 的 移动 ， 同 时 防止 其 他 方向 的 运动 。 防 止 那些 我 
们 所 不 希望 的 移动 给 我 们 带 来 更 具 挑战 性 的 设计 问 
题 。 结 构 的 变形 对 轴承 表面 构造 影响 很 大 ， 而 轴承 卖 
面 的 构造 又 影响 到 了 机 器 人 的 性 能 。 在 一 些 情形 中 ， 
由 于 载荷 引起 的 圆 简 偏 差 可 能 导致 会 妨碍 运动 的 阻 
塞 。 对 于 高 精度 的 移动 关节 ， 在 长 距离 下 也 要 保持 路 
径 的 直线 性 。 在 有 摩擦 的 多 重 表面 要 达到 要 求 的 精度 
是 十 分 虹 贵 的 。 移 动 关节 的 轴承 和 路 径 都 需要 被 昂贵 
并 且 大 面积 的 护 雷 所 覆盖 和 密封 。 

评价 大 量 的 〈 接 近 或 者 就 在 腕 关节 或 未 端 执行 
器 之 上 ) 线性 移动 关节 或 轴 的 主要 参数 是 刚度 - 质量 
比值 。 获 得 一 个 好 的 强度 -质量 比 需要 使 用 空心 或 者 
薄 壁 结构 ， 而 不 是 实心 的 运动 元 件 。 

轴承 间距 在 刚度 设计 时 也 至 关 重 要 。 如 果 间 距 
KH, 无论 轴 承 的 刚度 多 高 ， 系 统 刚度 都 会 不 够 。 
移动 关节 失效 的 主要 原因 是 混 人 了 杂质 以 及 表面 的 
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疲劳 磨损 ， 引 起 这 些 缺 陷 的 主要 原因 是 大 的 预 载 荷 、 
力矩 载荷 以 及 冲击 载荷 在 滚动 体 上 产 成 了 过 大 的 
负载 。 

由 于 具有 大 面积 的 暴露 在 外 的 精密 表面 ， 大 多 数 
移动 关节 相对 于 转动 关节 而 言 对 于 不 合理 操作 和 环境 
因素 更 加 敏感 。 同 时 ， 移 动 关节 也 更 加 难于 制造 、 装 
配 和 校 直 。 

移动 关节 中 滑动 元 件 的 常见 类 型 主要 有 铜 或 热 塑 
性 套 管 。 这 些 套 管 有 成 本 低 、 相 对 的 高 承载 能 力 和 可 
在 未 硬化 或 微 硬 化 表面 工作 等 优点 。 因 为 在 移动 元 件 
上 的 压力 被 分 散 了 ， 从 而 数值 较 小 ， 所 以 它 可 以 由 薄 
壁 套 管 来 做 成 。 另 外 一 种 常见 的 套 管 是 球状 套 管 。 相 
对 热塑性 套 管 来 说 ， 球 状 套 管 有 低 摩 擦 和 高 精度 等 优 
点 。 然 而 ,它们 需要 接触 表面 被 热处理 过 或 热 硬化 过 
(通常 需要 达到 55Re 或 更 高 的 硬度 ) ， 而 且 需 要 足够 
的 厚度 和 框架 结构 ， 从 而 能 够 承载 由 球 的 点 接触 特性 
而 带 来 的 高 应 力 。 

球 和 滚珠 导轨 在 机 器 人 的 移动 关节 中 也 很 常见 。 
此 滑动 结构 包含 两 种 基本 类 型 : 循环 和 非 循 环 。 非 
循环 的 球 和 滚珠 导轨 主要 应 用 于 短 位 移 装置 上 。 它 
们 具有 高 精度 以 及 低 摩 控 的 优点 ， 但 另 一 方面 ， 也 
因此 导致 其 对 冲击 敏感 ， 同 时 对 转 矩 负载 的 能 力 较 
差 。 相 对 来 说 ， 循 环球 和 滚珠 导轨 在 一 定 程度 上 没 
有 那么 精确 ， 但 是 能 承载 更 高 的 载荷 。 它 们 也 可 以 
被 用 来 承载 相对 较 大 的 载荷 ， 其 移动 区 间 也 可 以 有 
几米 之 长 。 商 业 用 的 可 循环 球 和 滚珠 导轨 已 经 大 大 
简化 了 直线 轴 的 设计 和 结构 ， 特 别 是 在 构架 和 轨道 
操纵 其 方面 。 

另外 一 种 常见 的 机 器 人 移动 关节 是 由 凸轮 附件 、 
滚 简 或 者 滚轮 组 成 的 ， 这 些 滚动 体 均 是 在 模压 、 氢 
模 、 机 加 工 或 者 磨 光 后 的 表面 上 进行 滚动 的 。 在 大 载 
倚 装 置 中 ， 滚 动 体 滚动 所 在 的 表面 必须 在 最 终 精 磨 之 
前 进行 硬化 处 理 。 同 轮 附 件 在 购买 时 会 带 有 独特 的 安 
装 杆 ， 它 可 以 被 用 来 辅助 装配 和 调整 ， 而 弹性 套 管 可 
以 使 运行 更 安静 和 顺畅 。 

两 种 较 少 见 的 机 器 人 移动 关节 是 以 弯 板 轴承 和 空 
气 轴承 为 特点 的 。 使 用 弯 板 轴承 的 关节 的 运动 是 由 文 
撑 零 件 的 梁 结 构 的 弹性 变形 提供 的 ， 因 此 ， 它 主要 应 
用 在 高 精度 、 准 线性 的 短 距 移动 上 。 空 气 轴 承 需 要 光 
滑 的 表面 ， 对 公差 的 近 距 离 控 制 ， 以 及 将 经 过 过 滤 且 
无 油 的 压缩 气体 稳定 地 通 人 人 其中。 两 个 或 者 三 个 自由 
度 的 空气 轴承 可 以 用 很 少 的 移动 结构 实现 多 轴 移 动 ， 
如 图 3. 12 所 示 。 

3. 关节 运动 

诊 部 、 肘 部 以 及 连接 件 的 旋转 关节 构 型 决定 了 机 





图 3. 12 Robotworld 是 一 款 具 有 多 空气 轴承 的 
完整 机 器 人 工作 单元 


械 臂 的 工作 范围 。 腕 部 关节 构 型 通常 决定 了 工件 在 其 
工作 范围 内 一 点 处 的 姿态 范围 〈 即 灵巧 工作 空间 ) 。 
当 和 需要 机 械 臂 到 达 一 个 在 扩大 的 任务 空间 中 的 特定 位 
置 时 ， 则 关节 行程 空间 会 增 大 ， 进 而 将 会 增加 构 型 参 
数 的 范围 。 比 如 在 可 控 路 径 运 动 ， 同 步 运动 以 及 检测 
运动 中 ,在 360° ~720° 之 间 的 腕 部 运动 范围 将 能 较 
好 地 实现 功能 。 在 装配 旋转 机 械 或 者 拧 螺纹 时 ， 连 续 
的 末端 关节 旋转 是 必需 的 。 

附加 关节 和 连接 件 虽 然 有 时 被 布置 在 机 器 人 本 体 
上 ， 但 更 多 情况 下 是 在 其 末端 执行 器 上 ， 这 些 关 节 和 
连 杆 是 也 能 够 增加 任务 空间 的 专用 工具 。 连 续 型 机 器 
人 和 可 控 路 径 机 器 人 的 运动 都 需要 考虑 能 够 必 开 奇异 
扩 的 运动 设置 (奇异 点 即 是 指 有 两 个 或 更 多 关节 共 
线 或 者 接近 共 线 的 区 域 ) ， 以 及 因此 而 造成 的 末端 执 
行 器 的 不 稳定 运动 。 一 个 通过 精心 控制 以 及 工作 单元 
布局 的 设计 而 实现 的 执行 器 可 以 增加 有 效 工 作 空 间 ， 
同时 利用 关键 路 径 设 置 来 避 开 奇异 点 区 域 。 例 如 ， 一 
个 标准 的 三 轴 机 人 种 人 腊 部 有 两 个 互 成 180° 的 奇异 后 ， 
而 这 个 角度 可 以 通过 一 个 能 够 减少 奇异 点 的 更 加 复杂 
的 胶 部 设计 增加 到 360" 。 这 样 的 腕 部 被 用 在 六 羊 毛 
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3.7.2 驱动 器 


驱动 器 为 机 器 人 提供 动力 源 。 大 多 数 机 器 人 驱动 
器 来 源 于 市 场 上 现 有 的 组 件 ， 当 然 ， 在 用 于 具体 的 项 
目 时 会 做 出 修改 以 适应 要 求 。 三 种 最 常用 的 驱动 器 分 
别 为 液压 式 、 气 动 式 和 电磁 式 。 

1. 液压 式 驱 动 器 

早期 的 工业 机 器 人 选用 的 是 液压 式 驱 动 器 ， 因 
为 它 能 提供 非常 大 的 作用 力 ， 并 有 非常 可 观 的 功率 - 
质量 比 。 在 液压 式 驱 动 器 中 ， 人 能量 来 自 于 由 电动 机 
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或 者 发 动机 带动 的 高 压 流 体 泵 ， 见 图 3. 10。 驱 动 器 
通常 有 直线 气 包 ， 旋 转 叶 轮 以 及 液压 电动 机 三 种 。 
驱动 控制 是 通过 电磁 隅 以 及 一 个 由 低 功 率 的 控制 电 
路 控制 的 伺服 阀 的 开 闭 来 实现 的 。 液 压 式 驱 动 器 需 
要 消耗 大 量 的 功率 ， 同 时 快速 反应 的 伺服 阀 成 本 也 
非常 高 。 漏 液 以 及 复杂 的 维护 也 限制 了 液压 驱动 机 
器 人 的 应 用 。 

2. 气动 式 驱动 器 

气动 式 驱 动 器 起 初 只 应 用 在 简单 的 执行 装置 上 。 
通常 ， 它 们 能 在 机 械 极限 之 内 提供 无 级 运动 。 这 种 
驱动 器 在 点 到 点 的 运动 中 表现 尤为 出 色 。 它 们 简单 
多 用 且 成 本 低 。 尽 管 有 些小 型 驱动 器 可 以 在 工厂 原 
有 人气 源 下 工作 ， 但 大 量 地 使 用 这 种 装置 需要 安装 昂 
贵 的 空气 压缩 系统 。 同 时 ， 和 气动 式 驱动 器 的 能 效 比 
较 低 。 

均衡 式 闭 环 伺服 气动 控制 器 已 经 研制 成 功 ， 并 
主要 被 运用 在 一 些 由 于 安全 、 环 境 和 应 用 场所 导致 
电 驱 动 不 能 满足 设计 要 求 的 场合 。DeLaval Interna- 
tional AB Tumba 的 主动 式 挤 奶 系统 (Voluntary Mil- 
king System) 就 是 一 个 例子 。 其 中 使 用 的 是 具有 电 - 
气 混合 驱动 阀门 关节 控制 的 气动 式 驱 动 ( 见 图 
3, 11) 

3. 电磁 式 驱 动 

当今 最 常见 的 驱动 莫 过 于 电磁 式 驱动 器 了 。 

1) 步 进 电动 机 。 一 些 诸如 台式 胶水 分 配 机 器 人 
之 类 的 简单 的 小 型 机 器 人 通常 就 使 用 永 伍 混合 式 或 
是 可 变 磁 阻 式 的 步 进 和 脉冲 电动 机 (R 3. 13)。 
这 种 机 器 人 使 用 开 环 的 位 置 及 速度 控制 。 它 们 的 成 
本 相对 比较 低 ， 并 且 与 电子 驱动 电路 的 接口 比较 容 
易 实 现 。 微 步 进 控 制 可 以 产生 10000 或 是 更 多 的 独 
立 的 机 器 关节 人 位置。 在 开 环 步 进 模式 下 ， 电 动机 以 
及 机 器 人 的 运动 有 很 显著 的 稳定 时 间 ， 而 这 种 现象 可 
以 通过 机 械 的 或 是 控制 算法 的 方式 进行 抑制 。 步 进 电 
动机 的 能 重 比 比 其 他 类 型 的 电动 机 更 小 。 有 闭环 控制 
功能 的 步 进 电 动机 与 直流 或 交流 的 何 服 电 动机 相似 
( OLY 3. 14), 

2) 永 磁 式 直流 电动 机 。 永 磁 式 直流 换 向 器 电动 
机 有 很 多 不 同 的 类 型 。 低 成 本 的 永 磁 电动 机 使 用 陶瓷 
( 铁 基 ) 磁铁 。 玩 具 机 器 人 和 非 专业 机 器 人 便 和 常常 应 
用 这 种 电动 机 。 化 铁 硼 由 于 其 最 强 的 磁性 ， 在 同等 体 
积 下 往往 可 以 产生 最 大 的 转 矩 和 功率 。 

无 铁心 的 转子 式 电 动机 通常 用 在 小 机 器 人 上 ， 其 
一 般 具 有 和 骨 人 环 氧 树脂 的 铀 导线 电容 ， 复 合 杯 状 结构 
或 是 盘 状 转子 结构 。 这 种 电动 机 有 很 多 优点 ， 比 如 电 
感 系数 很 低 ， 摩 擦 很 小 ， 昌 没有 髓 齿 转 矩 。 贺 盘 电 枢 





图 3.13 Sony 机 器 人 使 用 开 环 永 磁 步 进 电动 机 





图 3.14 Adept 机 器 人 使 用 闭环 控制 和 
可 变 磁 阻 电动 机 


式 电 动机 也 有 如 下 优点 ， 比 如 它们 的 总 体 尺 寸 较 小 。 
同时 ， 由 于 有 很 多 换 向 节 ， 其 可 以 产生 具有 低 转 和 矩 的 
平稳 输出 。 无 铁心 电 枢 式 电动 机 的 缺点 在 于 热 容量 很 
低 ， 因 为 其 质量 小 同时 传 热 的 通道 受到 了 限制 。 所 
以 ， 在 高 功率 工作 负荷 下 ， 它 们 有 严格 的 工作 循环 间 
院 限 制 以 及 被 动 空气 散热 需求 。 

3) 无 刷 电动 机 。 无 刷 电 动机 ， 也 分 交流 伺服 电 
动机 或 是 无 刷 直 流 电 动机 ， 通 常 是 应 用 在 工业 机 器 人 
上 (WLAN 3. 15 及 图 3. 16) 。 这 种 电动 机 使 用 光学 的 
或 者 磁场 的 传感器 以 及 电子 换 岗 电路 来 代替 石墨 电 刷 
以 及 铜 条 式 换 向 器 ， 因 此 可 以 减 小 摩擦 、 退 间 放 电 以 
及 换 向 器 的 磨损 。 无 刷 电动 机 在 低 成 本 的 条 件 下 表现 
突出 ， 主 要 归功 于 其 降低 了 电动 机 的 复杂 性 。 但 是 ， 
其 使 用 的 电动 机 的 控制 器 要 比 有 刷 电 动机 的 控制 器 更 
复杂 ， 成 本 也 要 更 高 。 无 刷 电 动机 的 被 动 式 多 磁极 钱 
磁铁 转子 以 及 铁 制 绕 线 定子 育 有 良好 的 散热 性 和 可 靠 
性 。 线 性 无 刷 电 动机 的 功用 与 铺展 开 的 回转 马达 相 
似 。 它 们 通常 有 一 个 又 长 又 重 的 被 动 式 多 磁极 乍 子 和 
义 短 又 轻 的 电子 换 向 式 绕 线 滑 块 。 
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图 3.15 Baldor 直流 伺服 电动 机 





图 3. 16 Anorad 无 刷 电动 机 


4. 其 他 驱动 器 

各 种 其 他 类 型 的 驱动 器 也 已 应 用 于 机 器 人 。 其 中 
一 个 范例 包括 应 用 了 热学 、 形 状 记忆 合金 〔SMA)、 
金属 、 化 学 、 压 电 、 磁 致 伸缩 、 电 聚合 物 (EPAM), 
弹性 容器 和 微机 电 系统 (MEMS) 的 驱动 器 ( 见 图 
3.17 和 图 3. 18) 。 大 多 数 这 些 驱动 器 已 应 用 于 研究 具 
有 特殊 应 用 的 机 器 人 ， 而 不 是 大 量 生产 的 工业 机 器 
人 。 压 电 陶 次 驱动 的 机 器 人 的 一 个 例子 是 PI 的 压 电 
式 六 足 亚 纳米 分 辨 率 平台 系统 ( 见 图 3.19)。 






图 3.17 ATLA EPAM 电动 机 


Ree 


图 3.18 lliptec 压 电 电动 机 





图 3. 19 PPI 的 压 电 式 六 足 亚 纳 米 分 辩 率 平台 系统 


3.7.3 变速 器 


传动 器 或 传动 系统 的 目的 是 将 机 械 动力 从 来 源 转 
移 到 受 载荷 处 。 设 计 和 选择 一 个 机 器 人 传动 机 构 时 ， 
需要 考虑 机 械 装置 的 运动 ， 负 载 和 电源 的 要 求 ， 以 及 
相对 于 关节 的 驱动 器 放置 位 置 。 在 传动 器 设计 中 ， 首 
先 要 考虑 的 是 传动 器 的 刚度 、 效 率 和 成 本 。 齿 际 和 扭 
转 都 会 影响 到 驱动 器 刚度 ， 尤 其 是 当 机 器 人 应 用 在 具 
有 连续 扭转 和 载荷 剧烈 变化 的 场合 中 。 高 传动 刚度 和 
低 此 隙 或 者 无 齿 际 均 会 导致 更 多 的 摩擦 损失 。 大 多 数 
机 器 人 传动 系统 当 工 作 在 接近 其 额定 功率 时 ， 具 有 和 良 
好 的 效率 ， 但 在 低 载 荷 时 便 不 一 定 了 。 过 大 的 传动 系 
统 会 增加 系统 的 重量 、 惯 性 和 摩擦 损失 。 不 良 传动 系 
统 设计 会 有 较 低 的 刚度 ， 在 持续 的 或 是 高 负荷 的 工作 
循环 下 快速 磨损 ， 或 者 在 偶然 的 过 载 下 失效 。 

机 器 人 的 关节 驱动 基本 上 是 由 传动 装置 来 实现 
的 ， 它 以 一 种 高 能 效 的 方式 通过 关节 将 驱动 髓 和 机 器 
人 连 杆 结合 起 来 。 各 种 各 样 的 传动 系统 形式 都 被 实际 
机 器 人 所 应 用 。 传 动机 构 的 传动 比 决定 了 驱动 器 到 连 
杆 的 转 矩 、 速 度 和 惯性 之 间 的 关系 。 传 动 系统 合理 的 
布置 ， 尺 二 以 及 机 构 设 计 决 定 了 机 器 人 的 刚度 、 质 量 
和 整体 操作 性 能 。 大 多 数 现代 机 器 人 都 应 用 了 高 效 
的 、 抗 过 载 破坏 的 、 可 反 向 的 传动 装置 。 

1. 直接 驱动 

直接 驱动 是 运动 学 中 最 简单 的 驱动 机 制 。 对 于 气 
动 或 液压 驱动 的 机 器 人 ， 了 驱动 器 直接 连接 在 连 杆 之 
间 。 直 接 驱 动 的 电动 机 器 人 采用 了 高 转 和 矩 、 低 速 的 电 
动机 直接 连接 到 连 杆 。 直 接 驱动 是 以 完全 去 除了 空 行 
程 和 平稳 转 矩 传动 系统 为 特点 的 。 但 是 ， 原 动 件 和 连 
杆 间 的 不 良 动态 匹配 〈 惯 性 比例 ) 使 这 种 传动 方式 ) 
需要 一 个 更 大 的 、 能 源 效益 较 低 的 驱动 器 。 

2. 带 传动 器 

直接 驱动 的 一 个 变形 是 带 驱动 。 薄 合金 钢 或 钛 制 
履带 被 固定 在 驱动 器 轴 和 被 驱动 的 连 杆 之 间 ， 用 来 产 
生 有 限 的 旋转 或 直线 运动 。 传 动 装置 的 传动 比 可 以 高 
达 10:1 (驱动 器 转 10 圈 ， 节 点 转 1 圈 )。 驱 动 器 质 
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量 也 从 有 点 处 移 开 了 一 -一 通常 移 至 基 座 处 ， 以 减少 机 
八 人 惯性 和 重力 负荷 。 它 相 比 缆绳 或 皮带 传动 而 言 ， 
是 一 种 更 柔顺 并 且 刚 性 更 好 的 传动 系统 。 

3. 皮带 传动 器 

同步 CT) 皮带 往往 应 用 于 较 小 的 机 器 人 的 传动 
机 构 和 一 些 大 机 器 人 的 轴 上 。 其 功能 大 致 和 带 传 动 相 
同 ,但 具有 连续 驱动 的 能 力 。 多 级 (两 个 或 三 个 ) 皮 
带 传动 有 时 会 被 用 来 生产 大 的 传动 比 〈 高 达 100: 1 )。 
张 紧 力 被 惰 轮 或 轴 臣 的 调整 所 控制 。 长 皮带 的 弹性 和 
质量 可 能 导致 驱动 不 稳定 ， 从 而 增加 机 器 人 的 稳定 
时 间 。 

4. 齿轮 传动 

直 齿 轮 或 斜 齿 轮 传 动 为 机 器 人 提供 了 可 靠 的 、 密 
封 的 、 低 维护 成 本 的 动力 传递 。 它 们 应 用 于 机 器 人 和 手 
腕 ， 在 这 些 手 腕 结构 中 多 个 轴线 的 相交 和 了 驱动 器 的 紧 
凑 型 布置 是 必需 的 。 大 直径 的 转盘 齿轮 用 于 大 型 机 器 
人 的 基 座 关节 ， 用 以 提供 高 的 刚度 来 传递 高 转 矩 。 贞 
轮 传 动 常用 于 台 座 ， 而 且 往 往 与 长 传动 轴 联 合 ， 实 现 
了 驱动 器 和 驱动 关节 之 间 的 长 上 距离 动力 传输 。 例 如 ， 
驱动 器 和 第 一 减速 器 可 能 被 安装 在 肘 部 的 附近 ， 通 过 
一 个 长 的 空心 传动 轴 来 驱动 男 一 级 布置 在 腕 部 的 减速 
器 或 差 速 器 ( 见 图 3. 1)。 

行星 齿轮 传动 常常 被 应 用 在 紧凑 的 齿轮 马达 中 
( 见 图 3.20) 。 为 了 尽量 减少 节点 齿轮 驱动 的 齿 阶 游 
E 〈 空 程 ) ， 齿 轮 传动 系统 需要 具有 仔细 的 设计 、 高 
的 精 庆 和 刚性 的 支撑 ， 用 来 产生 一 个 不 以 牺牲 刚度 、 
效率 和 精度 来 实现 小 时 隐 的 传动 机 构 。 机 器 人 的 齿 际 
游 移 被 一 些 方法 所 控制 ， 包 插 选 择 性 装配 、 齿 轮 中 心 
调整 和 专门 防 游 移 的 设计 。 


St... a ORES 
Se ene 


图 3.20 航天 飞机 的 机 械 辟 具有 行星 齿轮 驱动 器 


5. 蜗轮 传动 
蜗轮 蜗杆 传动 偶尔 会 被 应 用 于 低速 机 器 人 。 他 们 
的 特点 是 可 以 使 动力 正 交 的 偏转 或 者 平移 ， 同 时 具有 





高 的 传动 比 ， 机 构 简单 ， 以 及 具有 良好 的 刚度 和 承载 
能 力 。 男 一 方面 ， 他 们 的 低 效 率 使 他 们 在 大 传动 比 时 
具有 及 向 目 锁 特性 。 这 使 得 在 没有 动力 时 ， 关 节 会 自 
锁 在 它们 的 位 置 , 但 男 一 方面 ， 这 也 使 它们 容易 在 试 
图 手动 改变 机 表 人 位 置 的 过 程 中 被 损坏 。 

6. 专用 传动 装置 

专用 传动 装置 被 广泛 应 用 于 标准 工业 机 器 人 。 谐 
波 传 动 和 旋转 矢量 (RV) 传动 器 就 是 两 个 例子 ， 它 
们 具有 紧 竣 、 低 齿 际 滑 移 、 高 转 矩 传递 能 力 等 特点 ， 
同时 ， 其 使 用 了 特殊 齿轮 、 凸 轮 和 轴承 ( 见 图 3.21 
和 图 3.22), 





图 3.21 谐 波 传动 





图 3. 22 Nabtesco 旋转 矢量 传动 器 


谐 波 传动 器 常用 在 中 小 型 机 器 人 上 。 这 些 传动 器 
FLA BUR RI, (ERE Hie 
BCH PEF AA AVEC BS SE. DEFER BPE SAR FE BE H 
于 大 型 的 机 器 人 ， 特 别 是 受 超载 和 冲击 负荷 的 那些 机 
器 人 。 

7. 线性 传动 器 

直接 驱动 的 线性 传动 器 合并 了 直线 电动 机 与 一 个 
直线 轴 。 这 种 联系 往往 只 是 驱动 器 和 机 器 人 连 杆 之 间 
的 一 个 刚性 或 柔性 连接 。 另 外 ， 一 个 由 直线 电动 机 和 
其 导轨 组 成 的 总 成 被 直接 连接 到 线性 轴 上 。 直 接线 性 
电磁 驱动 器 的 特点 是 : 零 齿 隙 滑 移 ， 高 刚度 ， 高 的 速 
度 和 优良 的 性 能 ， 但 是 其 质量 也 较 大 ， 效 率 低 ， 成 本 
比 其 他 类 型 的 线性 驱动 器 更 高 。 

8. 滚珠 丝 杠 

滚珠 丝 杠 的 线性 传动 器 有 效 和 和 平顺 地 将 原 动 件 的 


第 3 章 机 构 与 驱动 67 


旋转 运动 变 成 直线 运动 。 通 常情 况 下 ， 循 环球 螺母 通 
过 与 平面 和 硬化 合金 钢丝 杠 的 配合 来 将 旋转 运动 转 
换 成 直线 运动 。 滚 珠 丝 杠 可 以 很 容易 地 与 线性 轴 匹 
配 。 紧 次 型 驱动 器 /传动 系统 总 成 ， 以 及 其 为 了 客户 
组 淡 而 设计 的 零件 都 已 经 实现 。 刚 度 对 短 距 的 和 中 
距 的 行程 比较 好 ,但 由 于 丝 杠 只 能 在 两 端 被 制 成 ， 
所 以 它 在 长 行程 中 的 刚度 并 不 好 。 通 过 精确 的 丝 杠 
可 以 获得 很 低 或 为 零 的 耸 孙 。 运 行 速度 被 丝 杠 的 力 
学 稳定 性 所 制约 ， 所 以 采用 旋转 螺母 的 方式 可 以 获 
得 更 高 的 速度 。 低 成 本 机 器 人 可 使 用 普通 丝 杠 传动 
装置 ， 它 的 特点 是 在 光滑 的 轧 制 丝 杠 上 采用 有 热 塑 
性 塑料 的 螺母 。 

9. 齿 条 积 齿轮 传动 系 

这 些 传统 的 传动 部 分 在 直线 ， 甚 至 弯曲 的 导轨 上 
对 长 距离 运动 是 有 益 的 。 刚 度 是 由 齿轮 / 齿 条 连接 处 
和 独立 行程 长 度 决 定 的 。 齿 际 滑 移 可 能 难以 控制 ， 因 
为 在 整个 行程 长 度 中 控制 齿 条 到 齿轮 中 心 的 公差 。 双 
齿轮 驱动 有 时 被 用 来 供 主 动 的 预 紧 力 ， 从 而 消除 齿 隙 
滑 移 。 由 于 较 低 的 传动 比 ， 有 效力 普遍 低 于 丝 杠 传动 
Ao HE (GR) 齿轮 的 重合 度 较 低 ， 因 而 易 
造成 振动 。 渐 开 线 齿 面 齿轮 需要 润滑 油 来 减少 磨损 。 
这 些 列 出 的 台式 传动 系统 经 常 被 应 用 于 大 型 龙门 式 机 
器 人 和 轨道 式 机 器 人 (ULAR 3. 23) 。 





图 3.23 NASA 龙门 式 机 器 人 


10. 其 他 传动 系统 组 件 

一 些 其 他 机 械 部件 的 例子 ， 如 花 键 轴 ， 运 动 间 的 
连接 件 (四 连 杆 ， 曲 柄 请 块 机 构 等 ) m, RER 
轴 器 ， 离 合 器 ， 制 动 器 ， 以 及 限 位 装置 ， 它 们 都 被 用 
于 机 器 人 传动 系统 中 ( 见 图 3.8). Yaskawa Robot- 
World 的 装配 和 过 程 自动 化 机 器 人 是 由 磁力 所 悬 置 ， 
在 一 个 两 自由 度 的 平面 空气 轴承 上 移动 ， 同 时 采用 直 
接 驱 动 平 面 电磁 马达 ， 并 且 内 部 没有 运动 部 件 ( 见 
图 3. 12)。 


3.8 ”机 器 人 的 性 能 


工业 机 右 人 的 性 能 往往 用 功能 运行 情况 和 循环 时 
间 来 体现 。 对 装配 机 器 人 来 说 ， 这 种 评价 标准 往往 是 
依据 每 分 钟 所 完成 的 取 放 往 环 次 数 。 弧 焊 机 器 人 往往 
被 设 定 了 一 个 缓慢 的 焊接 模式 和 摆动 速度 ， 以 及 一 个 
快 的 再 定位 速度 。 对 于 涂 装机 器 人 ， 附 着 或 覆盖 的 比 
率 和 喷雾 模式 下 的 速度 是 很 重要 的 。 机 器 人 的 峰值 速 
度 和 加 速度 列表 数据 一 般 只 是 计算 量 ， 由 于 在 机 器 人 
移动 过 程 中 产生 的 外 形 的 变化 而 带 来 了 动态 的 〈 惯 
性 ) 和 静态 的 (重力 ) 耦合 ， 因 而 其 峰值 加 速度 和 
速度 会 在 工作 过 程 中 有 所 变化 。 


3.8.1 机 器 人 速度 


最 大 的 关节 速度 (角速度 或 线 速度 ) 并 不 是 一 
个 独立 的 值 。 对 于 更 长 距离 的 运动 ， 它 往往 被 伺服 电 
动机 的 总 线 电 压 或 最 大 允许 的 电动 机 转速 所 限制 。 对 
于 大 如 速度 机 器 人 ， 甚 至 短 的 点 对 点 的 运动 也 可 能 有 
速度 限制 。 对 于 低 加 速 机 融 人 ， 仅 仅 总 体 的 运动 有 速 
度 限制 。 对 于 大 型 机 器 人 ， 典 型 的 末端 执行 器 峰值 速 
度 可 高 达 20m/s。 


3.8.2 机 器 人 加 速度 


在 大 多 数 现代 的 机 械 手 中 ， 因 为 和 机 械 壁 的 质量 
相 比 ， 有 效 载荷 的 质量 较 小 ， 因 而 更 多 的 动力 是 被 用 
于 加 速 机 咒 人 而 不 是 其 负载 。 加 速度 既 影 响 总 体 运动 
时 间 ， 也 影响 运行 周期 时 间 (总 体 运 动 时 间 加 稳定 
时 间 )。 能 够 承受 更 大 加 速度 的 机 械 辟 往往 是 刚性 更 
好 的 机 械 臂 。 在 高 性 能 机 械 臂 上 ， 比 起 速度 或 负载 能 
力 来 说 ， 加 速 和 稳定 时 间 是 更 重要 的 设计 参数 。 对 于 
一 些 装配 和 物料 装 印 的 机 器 人 而 言 ， 其 最 大 加 速度 比 
小 有 效 载荷 超过 了 10g。 


3.8.3 重复 性 


这 个 参量 代表 了 执行 器 多 次 返回 到 同一 个 位 置 的 
能 力 。 由 于 不 同 的 执行 器 运行 程序 设计 的 影响 ， 大 多 
数 制 造 商 更 倾向 于 以 一 个 他 们 自己 定义 的 参量 来 评价 
重复 性 。 这 个 参量 是 指 ， 从 同样 的 初始 位 置 开始 ， 采 
用 同样 的 程序 ， 载 荷 和 安装 设 定 ， 机 械 臂 能 够 回 到 初 
始 位 置 时 的 有 效 运行 球形 空间 的 半径 。 这 一 空间 可 能 
不 包括 的 目标 点 ， 因 为 计算 误差 、 简 化 的 校正 、 精 度 
的 限制 、 示 教 和 执行 模式 的 不 同 可 能 会 比 摩擦 、 未 解 
除 的 关节 和 传动 系 空 程 、 伺 服 系统 增益 以 及 结构 和 机 
械 装 配 过 程 中 的 空隙 导致 更 大 的 误差 。 设 计 者 必须 认 
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Å 


真 考虑 所 需 的 重复 性 评价 参量 。 当 进行 重复 的 工作 ， 
如 言 装配 或 机 器 载 人 时 ， 重 复 性 便 非 常 重要 。 典 型 重 


复 性 参数 的 范围 从 对 于 大 型 电焊 机 器 人 的 1 ~2mm 到 


对 于 精确 机 器 人 的 0. 005mm (Spm), 
3. 8.4 SRE 


这 个 参数 代表 的 是 能 够 由 执行 器 完成 的 最 小 增 量 
距离 。 在 传感器 控制 的 机 器 人 运动 和 精确 定位 中 ， 分 
辩 率 是 很 重要 的 。 尽 管 大 多 数 制造 商 依 据 关 节 位 置 纺 
人 码 器 的 分 辨 率 ， 或 伺服 电动 机 和 传动 装置 的 步 长 来 计 
算 系统 的 分 状 率 ， 但 这 是 一 种 误导 ， 因 为 系统 摩擦、 
扭曲 、 齿 阶 游 移 和 运动 的 配置 都 影响 着 系统 分 辨 率 。 
典型 的 编码 器 或 解析 器 的 分 辨 率 是 全 轴 或 节点 行程 的 
10 ~10” 分 之 一 , 但 实际 物理 分 辨 率 可 能 是 介 于 
0. 001 ~0. 5mm。 多 节点 串联 连接 机 械 璧 的 有 效 分 辩 
率 不 如 其 单个 关节 。 
精度 

这 个 参数 代表 的 是 机 器 人 在 空间 内 ， 将 其 执行 装 
置 定位 到 程序 设 定位 置 的 能 力 。 机 器 人 的 准确 性 对 于 
非 重 复 型 的 任务 非常 重要 ， 这 些 任务 既 可 能 被 数据 库 
中 的 程序 所 设 定 ， 也 可 以 是 一 种 在 安装 时 已 经 预 设 好 
的 ， 对 于 可 控 的 变化 进行 处 理 的 “ 示 教 任务 ”。 精 度 
是 一 个 手臂 关于 运动 学 模型 精确 度 (节点 类 型 、 连 
杆 长 度 、 关 节 之 间 的 角度 ,以 及 所 有 对 于 连 杆 或 节点 
在 负载 下 挠 度 的 核算 等 ) ， 空 间 、 工 具 、 夹 具 模型 的 
精度 ， 以 及 机 械 辟 方案 解决 路 径 的 完整 性 和 准确 性 的 
阴 数 。 虽 然 大 多 数 更 高 级 的 机 器 人 编程 语言 支持 机 械 
臂 解决 方案 ， 这 些 解决 方案 通常 只 是 建立 在 简化 的 刚 
性 结构 模型 的 基础 上 。 因 此 ， 机 器 人 精度 便 成 为 了 一 
个 匹配 机 器 人 几何 学 特性 和 机 器 人 解决 方案 的 问题 ， 
其 中 ， 我 们 需要 精确 地 测量 和 校准 连 杆 长 度 、 关 节 角 
度 和 安装 位 置 。 

典型 的 工业 机 器 人 精度 范围 从 具有 低级 计算 机 模 
型 的 非 标 定 执 行 器 的 + 10mm， 到 精确 的 机 械 工 具 执 
行 器 的 +0. 01mm， 此 执行 器 包含 了 具有 精确 动态 模 
型 和 和 解决 方案 的 控制 器 、 精 准 的 制造 工艺 ， 以 及 动态 
测量 元 件 。 


3.8.6 组 件 寿 命 与 占 空 比 


一 个 电动 机 器 人 中 ， 有 最 大 的 失败 问题 的 三 个 组 
件 是 驱动 器 〈 伺 服 电动 机 ) 、 传 动 装置 以 及 电源 和 信 
妃 电缆。 平均 故障 间隔 时 间 (MTBF) 应 至 少 在 
2000h ， 而 最 好 在 主要 部 件 所 计划 的 保养 维护 之 间 至 
少 有 5000 个 运行 h。 


3.8.5 


最 坏 情况 下 的 运动 周期 被 假定 为 用 最 新 机 器 人 装 
置 宛 成 一 般 性 的 重复 任务 。 装 配 机 器 人 的 小 行程 设计 
循环 寿命 (小 于 5% 的 关节 行程 范围 ) 应 该 达到 
20 ~100 万 次 完整 的 双向 循环 。 大 行程 循环 寿命 (大 
于 50% 的 关节 最 大 行程 范围 ) 应 通常 是 5 ~40 万 次 。 

短期 的 满 负 荷 工 作 往 往 被 传动 系统 的 最 大 载荷 所 
限制 ; 而 长 期 、 持 续 的 工作 性 能 则 被 电动 机 发 热 所 限 
制 。 对 于 某 一 个 期 望 的 占 空 比 进行 设计 ， 而 不 是 平等 
程度 的 同时 追求 短期 和 长 期 性 能 ， 可 以 节约 成 本 和 改 
进 性 能 。 这 种 方案 允许 我 们 使 用 更 小 、 惯 性 更 低 、 质 
量 更 轻 的 电动 机 。 工 业 机 器 人 通常 在 达到 设计 循环 寿 
命 之 前 就 已 经 因为 过 时 而 被 替换 。 


3.8.7 碰撞 


在 工作 中 ,意外 或 突 发 情况 可 能 偶尔 会 产生 碰 
撞 ， 涉 及 机 械 辟 及 其 工具 、 工 件 或 工作 空间 内 的 其 他 
物体 。 这 些 事故 可 能 会 导致 各 种 程度 的 破坏 ， 其 破坏 
的 程度 在 很 大 一 部 分 取 次 于 机 械 臂 的 设计 。 如 果 在 这 
类 事故 中 的 时 间 成 本 和 费用 损失 很 大 ， 那 么 抵抗 碰撞 
的 设计 方案 就 应 在 设计 过 程 中 尽早 考虑 。 由 事故 造成 
的 典型 损害 包括 齿轮 或 轴 的 折断 或 剪 切 失效 ， 连 杆 结 
构 的 四 陷 或 弯曲 ， 齿 轮 的 滑动 或 轴 的 罕 动 ， 电 线 、 腿 
强 或 者 软 管 的 断裂 ， 严 重 磨损 或 变形 ， 以 及 连接 器 ， 
配件 ， 限 位 器 或 开关 的 损坏 。 和 柔性 的 原件 ， 如 超载 
(滑动 ) 离合 器 ， 弹 性 元 件 和 带 软 垫 的 表面 可 以 被 用 
来 减少 发 生 碰 撞 的 冲击 负荷 ， 从 而 帮助 解 看 或 这 在 这 
类 碰撞 中 隔离 驱动 器 和 传动 系统 。 


3.9 结论 与 扩展 阅读 


机 器 人 的 机 械 设计 是 一 个 反复 的 过 程 ， 涉 及 工 
程 、 技 术 和 应 用 的 具体 因素 的 评价 和 选择 。 最 后 的 
设计 方案 应 反映 出 对 于 设计 任务 的 详细 要 求 的 仔细 
考虑 ， 而 不 是 仅仅 的 广义 规范 。 对 于 这 些 设计 要 求 
的 正确 的 定义 和 理解 是 实现 设计 目标 的 一 个 关键 
因素 。 

设计 和 选择 具体 的 组 成 部 分 涉及 权衡 的 考虑 。 纯 
静态 的 ， 刚 体 机 器 人 的 设计 是 经 常 被 应 用 的 ， 但 其 并 
不 总 是 充分 的 。 机 械 系 统 的 刚度 、 固 有 频率 、 控 制 系 
统 的 兼容 性 ， 以 及 期 望 的 机 器 人 应 用 和 安装 要 求 都 必 
须 加 以 考虑 。 

关于 构成 机 器 人 系统 核心 的 机 构 和 原 动 件 设计 还 
有 许多 其 他 文献 。 其 中 一 个 著名 并 且 正 在 使 用 的 机 器 
人 设计 参考 资料 是 Rivin [3.44], 

Craigi? ©) 和 Tsai!*?! 提供 了 机 器 人 的 机 械 结构 与 
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其 工作 空间 和 机 械 增 益 的 数学 关系 。 Sclater 各 Chiro- 
nis * “8! 是 对 于 多 种 有 效 的 应 用 装置 的 宝贵 汇编 的 一 
次 再 版 ， 比 如 关节 传动 系统 和 传动 装置 。McCart- 
ney!) 包括 了 设计 特定 机 构 的 几何 技术 。 

Juvinall 和 Marshek 4 和 ， 以 及 Shigley 和 Mish- 
kel) 是 关于 像 连 杆 结构 、 轴 和 承 ， 以 及 传动 系统 这 
样 结构 的 设计 的 重要 参考 资料 ， 而 这 些 都 对 机 器 人 系 
统 的 机 械 性 能 效率 起 到 了 至 关 重 要 的 作用 。 

虽然 许多 设计 决策 可 以 通过 应 用 简单 直接 的 算法 
和 公式 获得 ， 但 是 许多 其 他 重要 的 因素 使 得 机 顺 人 设 
计 成 为 了 一 个 需要 良好 的 工程 判断 力 的 挑战 。 
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Bae 传 感 与 估计 


Henrik I. Christensen, Gregory D. Hager 
{hah i% 


传 感 与 估计 是 任何 机 器 人 系统 设计 的 核心 。 在 
底层 ， 反 馈 控制 必须 要 估计 机 器 人 自身 的 状态 。 在 
高 层 ， 传 感 ， 此 处 定义 为 以 任务 为 导向 的 传感器 数 
据 解释 ， 可 以 在 空间 和 时 间 领 域 融合 传感器 信息 来 
促进 规划 。 

本 章 概述 了 在 机 器 人 领域 广泛 应 用 的 常见 传 感 
和 估计 方法 。 本 章 内 容 按照 过 程 模型 来 组 织 ， 包 括 
传 感 ， 特 征 提 取 ， 数 据 关联 ， 参 数 估计 和 模型 整 
合 。 本 章 介绍 和 描述 了 几 种 常用 的 传 感 模式 的 特 
征 ， 并 讨论 线性 和 非 线性 系统 中 常见 的 估计 方法 ， 
包括 统计 学 估计 、 凯 尔 曼 滤波 和 采样 法 。 本 章 也 简 
单 介绍 了 重 棒 估计 的 策略 。 最 后 介绍 几 种 常用 的 信 
计 表 示 法 。 


如 果 有 一 个 完整 的 环境 模型 ， 并 且 机 器 人 促 动 
右 能 够 相对 于 该 模型 完美 地 执行 运动 指令 ,那么 控 
制 机 家 人 系统 将 变 得 相对 简单 。 很 遗 刍 的 是 ， 大 多 
数 时 候 完 整 的 环境 模型 并 不 具备 ， 机 械 构造 的 理想 
控制 也 从 来 都 不 现实 。 在 这 种 情况 下 ， 传 感 和 估计 
方法 被 用 来 弥补 完整 信息 的 缺失 。 它 们 的 功能 就 是 
提供 环境 和 机 器 人 系统 的 状态 信息 ， 作 为 控制 ， 决 
策 以 及 与 环境 中 其 他 单元 (例如 人 ) 进行 交互 的 
基础 。 

为 便于 讨论 ， 我们 区 分 用 于 还 原 机 右 人 自身 状 
态 的 传 感 和 估计 为 “本 体感 受 ”", 并 区 分 用 于 还 原 
外 部 世界 状态 的 传 感 和 信 计 为 “外 感受 ”。 在 实际 
应 用 中 ， 绝 大 多 数 机 器 人 系统 设计 有 本 体感 受 来 估 
计 和 控制 自身 的 物理 状态 。 男 一 方面 ， 通 过 传感器 
数据 来 还 原 外 部 环境 状态 通常 是 一 个 更 广泛 也 更 复 
杂 的 问题 。 | 

星期 的 机 器 人 计算 感知 研究 假定 我 们 可 以 复原 出 
一 个 完整 通用 的 环境 模型 ， 并 用 它 来 进行 决策 和 驱 
动 ， 参 见 参考 文献 [4.1] 中 的 范例 。 最 近 ， 该 方法 
已 经 很 明显 地 不 切实 际 了 。 事 实 上 ， 考 虑 到 基于 传 感 
器 的 机 器 人 已 经 出 现在 各 种 领域 ， 例 如 移动 监控 、 高 
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性 能 操作 和 医疗 介入 ， 对 于 一 个 给 定 的 系统 ， 适 合 的 
传 感 和 估计 很 明显 高 度 依赖 于 系统 的 任务 。 因 此 ， 此 
处 的 讨论 按照 以 任务 为 导向 的 外 部 世界 传 感 和 估计 来 
组 织 。 

传 感 和 估计 可 被 视 为 一 个 将 物理 数量 转换 为 可 用 
于 进一步 处 理 的 计算 机 表达 的 过 程 。 因 此 传 感 与 将 物 
理 存 在 转换 为 可 被 计算 机 处 理 的 信和 叶 的 转换 器 紧密 关 
联 。 传 感 也 与 感知 ， 即 在 以 任务 为 导向 的 环境 模型 中 
表征 传感器 信息 这 一 过 程 ， 密 切 相 关 。 然 而 ， 传 感 器 
数据 通常 以 不 同 的 方式 损坏 ， 导 致 该 过 程 更 加 复杂 。 
举例 而 言 ， 转 换 器 环节 产生 统计 学 噪声 ， 数 字 化 过 程 
中 引入 离散 化 ， 传 感 器 选择 不 良 引 和 人 模糊 量 等 。 因 此 
引 人 佑 计 方 法 来 支持 将 信息 恰当 地 融合 进 环境 模型 ， 
并 提高 信 噪 比 。 

本 章 介绍 传 感 与 估计 的 通用 特征 ， 而 本 手册 的 第 
3 篇 提供 了 部 分 更 深入 的 主题 内 容 。 本 章 4.1 节 介 绍 
传 感 / 舍 计 的 总 体 过 程 。4.2 节 介 绍 不 同 种 类 的 传 感 
器 以 及 它们 的 关键 特性 。4.3 节 讨 论 环境 表征 的 估 
计 ， 可 利用 包括 参数 化 和 非 参 数 化 途径 在 内 的 多 种 不 
同方 法 。4. 4 节 找 述 多 种 环境 表征 方法 ， 适 用 于 基于 
模型 的 信息 融合 。 
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4.1 感知 过 程 


感知 过 程 的 输入 通常 有 两 种 ，@D 来 源 于 各 种 传 感 
器 /转换 器 的 数字 信和 号，@ 不 完整 的 环境 模型 (世界 
模型 ) ， 包 含 机 顺 人 和 外 部 世界 中 其 他 相关 实体 的 状 
态 信 息 。 传 感 器 数据 本 身 可 以 是 多 种 不 同 的 格式 ， 例 
如 标量 或 者 是 基于 时 序 x(1) 获取 的 向 量 xla, B), 
扫描 量 *, (6) ， 向 量 场 x 或 者 三 维 容积 x(p，8， 中 ) 。 
在 许多 情况 下 ， 系 统 必 须 融 合 来 自 多 个 传感器 的 数 


特征 提取 f 






图 4.1 本 章 所 讨论 的 感知 过 程 范例 


传感器 处 理 的 初始 问题 是 数据 预 处 理 和 特征 提 
取 。 预 处 理 的 目的 是 降低 转换 器 的 噪声 ， 移 除 任何 系 
统 化 误差 ， 优 化 数据 的 相关 属性 。 在 某 些 情况 下 ， 传 
感 器 信息 需要 在 时 域 或 空域 进行 校准 以 进行 下 一 步 的 
融合 。 有 很 多 种 方式 可 用 来 预 处 理 数据 ， 以 优化 或 者 
提取 特征 用 于 数据 融合 。 常 用 的 一 种 方法 是 模型 匹 


SO = WN awe) ` Un ON 


y (m) 








x (m) 


a) 


匹配 (关联 ) | 
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据 ， 例 如 ， 佑 计 移动 机 器 人 的 位 置 需要 融合 来 自 于 转 
轴 编 码 器 、 视 觉 系统 、 全 球 定位 系统 (GPS) 和 惯性 
{EIR AS BEE o 

为 进一步 组 织 本 章 讨 论 ， 我 们 采用 如 图 4. 1 所 示 、 
的 感知 过 程 通用 模型 。 在 该 模型 中 ， 包 括 了 适用 于 利 
用 直 界 模型 融合 传 感 需 数据 的 最 常用 操作 。 针 对 所 讨 
论 的 任务 ， 某 些 模 块 可 能 缺席 ， 而 另外 一 些 模块 自身 
可 能 包含 复杂 的 结构 。 但 是 ， 所 提供 的 模型 足以 用 来 
解释 传 感 与 预测 中 的 许多 问题 。 接 下 来 本 节 将 通过 一 
个 移动 机 器 人 定位 的 范例 来 解释 这 个 模型 。 






配 ， 如 图 4. 2 中 所 示 的 激光 扫描 仪 。 一 旦 传感器 信息 
可 用 ,通常 需要 将 数据 与 已 有 的 模型 进行 匹配 (J 
图 4.3)。 该 模型 可 能 基于 一 个 预知 的 结构 (例如 ， 
环境 的 一 个 计算 机 辅助 设计 (CAD) 模型 ) ， 或 者 由 
之 前 获取 的 数据 所 建立 。 数 据 关联 方法 通常 用 于 估计 
传感器 数据 与 环境 模型 之 间 的 关系 。 在 我 们 的 移动 机 


y(m) 








图 4.2 ”从 激光 扫描 进行 特征 提取 的 范例 ( 参考 文献 [4.2」) 
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甬 人 定位 范例 中 ， 所 提取 的 直线 特征 与 一 个 多 边 形 世 
界 模 型 相 匹配 。 该 匹配 过 程 可 经 由 几 种 不 同 的 方式 进 
行 ， 但 是 总 体 上 ， 它 是 一 个 以 最 大 化 特征 与 模型 之 间 
的 校准 为 目标 的 优化 问题 。 





图 4.3 用 于 移动 机 器 人 定位 的 环境 模型 
范例 ( 参考 文献 [4.2] ) 


一 旦 传感器 数据 与 世界 模型 匹配 之 后 ， 可 利用 传 
感 器 数据 所 包含 的 信息 来 更 新 模型 。 在 上 述 范例 中 ， 
机 器 人 相对 于 世界 模型 的 方向 和 位 置 可 通过 匹配 的 直 
线段 来 更 新 如 图 4.4 所 示 。 





图 4.4 估计 移动 机 器 人 实例 的 位 置 和 
方向 (参考 文献 [4.2 ] ) 


最 后 ， 设 计 一 个 动态 系统 模型 来 模拟 待 估计 的 相 
关 状 态 是 有 可 能 的 。 通 过 这 样 的 系统 模型 ， 在 获取 到 
新 的 传 感 占 数据 之 前 预测 环境 随时 间 的 变化 是 可 能 
的 。 该 方法 可 用 于 前 馈 型 预测 过 程 ， 并 可 以 反 过 来 简 


表 4.1 根据 传 感 对 象 (本体 感受 (PC)/ 外 感受 (EC)) 和 使 用 方法 
(主动 式 / 被 动 式 ) 对 机 器 人 常用 传感器 的 分 类 








开关 /缓冲 器 











化 新 的 传感器 读数 的 数据 关联 ， 见 图 4. 1。 
下 面 我 们 将 详细 讨论 感知 过 程 的 每 一 个 步 又 。 


4.2 传感器 


根据 测量 的 对 象 以 及 如 何 测量 ， 有 很 多 种 方式 来 
对 传感器 进行 归 类 。 如 前 所 述 ， 本 体感 受 传感器 用 来 
测量 机 器 人 的 内 部 状态 ,包括 具有 不 同 自由 度 的 位 
曾 、 温 度 、 关 键 部 件 的 电压 、 电 动机 电流 、 促 动 器 受 
力 等 等 。 在 男 一 方面 ， 外 感受 传感器 生成 外 部 环境 的 
有 关 信 息 ， 例 如 与 某 物体 的 距离 、 相 互 作用 力 、 组 织 
的 密度 等 。 

传感器 也 可 以 区 分 为 被 动 或 者 是 主动 类 型 。 总 体 
上 ， 主 动 型 传感器 将 能 量 释放 到 环境 中 ， 并 基于 反应 
来 测量 环境 属性 。 被 动 型 传感器 则 不 会 主动 测量 。 由 
于 主动 型 传感器 对 被 测 信 号 施加 某 种 控制 ， 所 以 它们 
通 前 比 锌 动 型 传感器 更 具 鲁 棒 性 。 例 如 ， 执 行 特 征 匹 
配 以 进行 三 角 化 时 ， 被 动 型 立体 相机 系统 必须 依赖 于 
所 观察 表面 的 外 观 〈 见 第 22 章 ) ， 然 而 结构 光 系 统 
将 采种 模式 光 投 射 人 场景 ， 因 此 对 场景 的 特征 不 是 很 
敏感 。 即 使 如 此 ， 所 发 射 信号 的 吸收 、 散 射 或 者 干扰 
会 影响 主动 型 传感器 的 性 能 。 

本 体感 受 传感器 通常 是 被 动 型 ， 用 来 测量 机 器 人 
的 物理 属性 ， 例 如 关节 位 置 、 速 度 ， 或 者 加 速度 、 马 
达 扭 矩 等 。 另 一 方面 ， 外 感受 传感器 可 进一步 划分 为 
接触 式 传 感 型 和 非 接触 式 传 感 型 。 接 触 式 传感器 通常 
与 本 体感 受 所 使 用 的 传感器 是 同一 类 型 ， 而 非 接触 式 
传感器 包含 绝 大 多 数 以 一 定 距 离 估计 物理 属性 的 传 感 
类 型 ， 包 括 强度 、 范 围 、 方 向 、 尺 寸 等 。 

表 4. 1 列 出 了 按照 使 用 方法 和 典型 应 用 对 典型 传 
感 融 进行 的 分 类 。 有 关 传 感 方法 ， 传 感 器 特征 和 常见 
应 用 的 更 多 细节 可 以 在 诸如 现代 传感器 手册 “” 和 本 
手册 第 3 篇 找到 。 











触 压 式 传 感 器 FER 
ERENER A 
接触 矩阵 

触觉 传感器 J/M 


阻抗 式 传感器 
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( 续 ) 


电 刷 编码 器 
电压 计 
分 解 器 
光学 编码 器 
磁性 编码 器 
电感 式 编码 器 
电容 式 编码 器 


指南 针 
陀螺 仪 
TRHA 








马达 /转轴 传感器 






























方位 传感器 










CPS 
主动 式 光 学 传感器 
RF fap 
超声 信 标 


反射 式 信 标 


电容 式 传感器 
HEHE fe Rat 
相机 
声呐 
激光 测 距 仪 
结构 光 






基于 信 标 的 传感器 
(相对 于 某 惯性 坐标 系 的 位 置 ) 
























速度 /运动 传感器 











相机 
无 线 射 频 识 别 (RFID) 
激光 测 距 仪 
雷达 
超声 
声波 







Wate eat 







旋转 和 运动 的 估计 是 控制 机 械 手 和 估计 移动 系统 自 





状态 通道 A 通道 B 
:| 





主 运动 的 基础 。 测 量 旋转 运动 最 常见 的 传感器 是 正 交 高 多 
编码 器 。 它 由 一 个 透明 盘 片 组 成 ， 具 备 两 种 异 相 的 周 yO 
期 性 模 态 ， 如 图 4.5 所 示 。 通 过 计数 器 ， 可 以 直接 计 4 低 低 





算 位 移 和 方向 (图 4.5 中 传感器 A 和 B 之 间 的 相 
位 )。 而且， 盘 片 外 边缘 通常 刻 有 小 洞 来 提供 标 引 
(规定 零 位 )。 图 案 的 密度 决定 测量 的 解析 度 。 将 该 
传感器 安装 至 马达 减速 齿轮 的 上 游 ， 精 确 度 可 轻易 超 估计。 这 些 单元 产生 的 电压 值 与 引入 的 变形 量 成 正 
过 1/1000° 。 比 。 通 过 谨慎 地 布置 传感器 ， 可 同时 测量 受 力 和 扭 

末端 执行 器 处 的 受 力 和 扭矩 可 以 采用 压 电 单元 来 ”和气 。 这 种 传感器 用 于 机 器 人 操纵 中 估计 应 力 和 接触 ， 


图 4.5 正 奖 编码 器 盘 片 图 ， 以 及 光 侦 测 器 在 两 种 
模式 下 的 输出 ( 相应 的 状态 变化 示 于 图 右 侧 ) 
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域 。 市 面 上 的 力 /扭矩 传感器 有 着 各 种 尺寸 和 动态 范 
围 ， 包 括 新 型 的 可 安装 在 不 同 末端 执行 器 上 的 灵活 阵 
列传 感 占 ( 见 图 4.6)。 力 传感器 的 潜在 问题 是 初始 
接触 存在 不 工作 区 ， 以 及 基本 传 感 环节 产生 干扰 信 
号 ， 需 要 通过 信和 号 处 理 来 清除 。 








b) 


图 4.6 灵活 阵列 传感器 
a) 触觉 阵列 (FA Pressure Profile Systems 公司 所 生产 的 
一 种 灵活 的 电容 性 接触 式 传 感 顺 阵列， 适用 于 滑动 状态 
下 的 接触 位 置 和 区 域 传 感 ) b) 触觉 阵列 传感器 可 以 舒 
服 的 戴 在 人 手 或 者 机 器 人 手 上 (Pressure Profile Systems 
公司 许可 提供 ) 


自主 运动 的 估计 是 几乎 所 有 机 器 人 系统 的 重要 一 
环 。 为 此 ， 可 应 用 惯性 测量 单元 (IMU). IMU 通常 
包括 加 速度 计 和 陀螺 仪 。 加 速度 计 对 各 种 类 型 的 加 速 
度 者 敏感， 意味 着 可 一 起 测量 平 动 和 转动 《离心 
力 ) 。IMU 单元 可 以 估计 旋转 和 和平 动 ， 可 通过 二 重 积 
分 来 估计 系统 的 速度 、 方 位 和 位 置 ， 参见 参 考 文献 
[4.4] 中 的 范例 。IMU 使 用 中 存在 的 一 个 问题 是 需 
要 进行 二 重 积分 。 小 的 偶 移 和 干扰 可 造成 最 终结 采 的 
严重 偏离 ， 因 此 需要 详细 的 传感器 模型 ， 并 对 传感器 
进行 着 慎 矫 正和 特征 识别 。 图 4.7 给 出 了 行驶 于 沙土 
路 面 的 汽车 上 所 装配 的 十 字号 形 DMU-6x 型 单元 的 数 
据 范例 。 

最 早期 的 移动 机 器 人 、 水 下 机 器 人 以 及 某 些 医疗 
机 器 人 的 研究 依赖 于 超声 测 距 。 通 用 的 此 类 传感器 稼 
被 称 为 声波 导航 与 测 距 仪 (声呐 )。 一 般 原理 是 系统 
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图 4.7 用 于 沙土 路 面 驾驶 的 IMU 单元 的 数据 范例 


释放 出 声波 脉冲 ， 并 等 待 其 碰 到 环境 中 的 物体 之 后 反 
弹 回 来 。 已 知 介质 中 的 传递 速度 和 声波 传递 所 用 的 时 
间 ， 可 以 计算 出 距离 。 因 为 这 种 低 成 本 的 传感器 可 以 
提供 适中 的 性 能 ， 所 以 该 方法 广泛 应 用 于 早期 机 器 
人 。 目 前， 声呐 仍然 是 水 下 机 器 人 采用 的 主要 传感器 
类 型 。 第 21 章 将 详细 讨论 这 种 传感器 。 

近期 的 机 器 人 进展 ， 特 别 是 环境 模拟 和 导航 ， 在 
许多 方面 都 归功 于 低 成 本 高 灵敏 度 激 光 扫 描 系 统 的 出 
现 。SICK 系列 激光 扫描 仪 属 干 渡 越 时 间 型 扫描 仪 。 
扫 摘 仪 放 出 光 脉 冲 ， 并 测量 返回 所 需 时 间 ， 如 图 4.8 
所 示 。 在 厘米 或 者 宣 米 级 精确 度 下 ， 标 准 扫描 仪 测量 
中 离 可 高 达 80m。 扫 描 仪 在 一 个 平面 上 以 0.5° ~1° 的 
角 分 辨 率 测量 距离 。 可 视角 度 180°, ， 产 生 181 ~ 361 
次 测量 。 均 匀 分 布 干扰 会 污染 传感器 数据 ， 这 一 点 在 
特征 识别 或 者 将 数据 融合 为 原始 传感器 地 图 时 必须 加 
以 考虑 。 





图 4.8 广泛 用 于 移动 机 器 人 的 激光 测 距 
传感器 示例 (SICK LMS291 ) 
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对 传 感 和 估计 来 说 ， 图 像 传 感 器 是 丰富 的 信息 来 
源 。 图 像 传感器 有 多 种 不 同 的 配置 ， 例 如 不 同 的 几何 
成 像 、 图 像 解析 度 、 传 感 器 技术 以 及 传 感 频谱 。 大 部 
分 读者 一 定 都 很 熟悉 传统 的 3CCD 透视 彩色 相机 。 该 
设备 含有 3 A REARS (CCD) 阵列 ， 分 别 接 
受 对 应 人 眼 视 觉 的 红 、 绿 和 蓝 色 的 可 见 光 谱 部 分 。 更 
常见 且 较 便宜 的 一 种 替代 设备 称 为 单 芯 片 CCD 相机 。 
该 设备 采用 一 组 空间 特别 排列 的 滤 色 镜 ， 通 称 为 拜 尔 
滤 镜 ， 因 它 的 发 明 人 布 赖 斯 拜 尔 而 得 名 。 滤 镜 组 再 
进一步 处 理 〈 称 为 去 马赛 克 处 理 ) ， 以 提供 每 一 个 像 
素 点 的 色彩 信息 。 

在 美国 ， 根 据 为 电视 信号 模拟 传输 制定 的 NTSC 
标准 ， 图 像 传 感 器 传统 上 包含 480 行 ， 每 行 640 个 像 
素 点 。 对 应 的 欧洲 标准 PAL 包含 576 线 ， 每 线 768 个 
像素 点 。 最 近 ， 数 字 式 接口 的 演化 ， 例 如 IEEE 1394 
All USB 2. 0 已 经 允许 相机 系统 的 解析 度 达到 百 万 像素 
的 范围 。 与 此 同时 ， 成 本 较 低 廉 的 红外 (IR) A 
Sht (UV) 照相 机 也 出 现 了 ， 因 此 可 以 开发 更 高 等 
的 多 谱 段 图 像 处 理 系统 。 

传统 图 像 传感器 含有 一 个 光学 系统 ， 将 光 汇 聚 在 
一 个 平面 图 像 阵列 上 。 大 多 数 时 候 ， 该 系统 可 以 用 经 
典 的 针 孔 相机 模型 ( 见 图 4.9) 来 模拟 。 给 定 欧 几 里 
德 空间 中 的 一 个 点 (x,，y，z) ， 对 应 的 照相 机 像素 
坐标 (u, o) 为 

(u-u) = 2 


(v-»,) =£ (4.1) 


AF, 是 镜头 系统 的 焦距 ; u Me ERE POAR 
像素 坐标 ; s-. 和 s, 是 图 像 阵 列 上 单个 像素 点 的 尺寸 。 
实际 应 用 中 ， 这 些 模 型 也 可 用 低 阶 图 像 失 真 模型 来 加 
以 补充 。 对 于 一 个 给 定 的 相机 系统 ， 这 些 参 数值 可 通 
过 多 种 试验 方法 来 确定 “5 。 

将 传统 的 透视 相机 与 反光 镜 组 合成 所 谓 的 反 
射 折射 光学 系统 ， 生 成 的 图 像 几 何 可 将 宽度 达 半 
球体 的 视野 映射 至 单 幅 图 像 。 该 系统 有 很 多 用 处 ， 
譬如 监控 系统 ， 该 系统 的 几何 属性 可 为 移动 导航 
提供 稳定 的 定位 参考 “;。 图 4.10 给 出 了 一 幅 图 
像 示例 ， 以 及 该 图 像 映 射 到 圆柱 体 表面 所 生成 的 
图 像 。 

上 述 讨 论 涉及 最 常用 的 机 器 人 传 感 设 备 。 在 
特定 的 应 用 中 会 用 到 很 多 专用 传感器 ， 它 们 在 制 
药 (第 52 章 ) 领域 、 超 声 、X 射线 、 计 算 机 斯 层 
扫描 和 磁 共 振 成 像 中 被 广泛 应 用 ; 在 矿坑 制图 中 
使 用 穿 地 雷达 “”。 水 下 机 器 人 利用 多 种 声学 传 感 








y 





图 像 平面 


图 4.9 针 孔 相机 模型 





图 4. 10 反射 折射 图 像 和 将 其 映射 到 
圆柱 体 表 面 生 成 的 图 像 


占 。 关 于 这 些 更 具有 目标 指向 性 的 传 感 形 式 的 更 
深层 讨论 ， 可 以 参考 本 手册 第 3 篇 的 应 用 章节 。 


4.3 ”估计 过 程 


简介 部 分 提 到 可 用 多 种 不 同 的 方法 对 来 自传 感 髓 
的 信息 进行 综合 。 哪 一 种 方法 更 适合 很 大 程度 上 依赖 
于 对 环境 的 事先 了 解 程度 ， 何 种 信息 是 当前 任务 所 必 
需 的 ， 以 及 哪 种 模型 更 适 合 传 感 系统 。 常 见方 法 包括 
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基于 表决 的 简单 方法 ， 人 参数 型 和 非 参 数 型 统计 估计 
法 ,模糊 逻 辑 系统 和 Dempster- Shafer 证 据 理 论 。 

为 说 明 这 一 点 ， 让 我 们 再 考虑 4. 1 节 介 绍 的 机 器 
人 定位 问题 。 如 果 一 开始 对 环境 一 无 所 知 ， 机 器 人 可 
能 接收 激光 扫描 信和 号 并 试图 用 直线 段 来 产生 初始 环境 
模型 。 因 为 事先 一 无 所 知 ， 系 统 必 须 估 计 线 段 的 数量 、 
线段 与 数据 观测 值 之 间 的 数据 关联 以 及 线段 本 身 的 参 
数 。 这 个 问题 具有 挑战 性 ， 可 采用 简单 表决 技术 求解 ， 
BEREM 或 者 随机 抽样 一 致 ( RANSAC) 
法 "或 者 更 复杂 的 无 监督 型 集群 方法 ,例如 上 均 
值 “" ， 最 大 期 望 值 (EM)“'" ， 或 者 全 局 主 成 分 分 
i (GPCA) Fry") ,在 许多 情况 下 ， 这 是 一 个 演 
算 密 集 的 和 迭代 过 程 。 

相反 ， 如 果 已 知 环境 的 CAD 模型 ， 问 题 演 变 为 
生成 少数 几 个 模型 参数 ( 平 动 和 转动 ) 以 匹配 数 
据 。 该 问题 可 通过 特征 匹配 来 求解 ， 利 用 和 迭代 最 近 
点 算法 (ICP) 21 或 者 其 他 有 效 的 组 合 匹 配 算法 例 
如 蒙特 卡 洛 法 “” ， 将 观察 点 与 模型 比 对 。 何 种 方 
法 最 适合 很 大 程度 上 仍然 依赖 于 环境 的 结构 和 事先 
所 知 。 

对 环境 有 了 初始 了 解 之 后 ， 新 的 数据 可 以 利用 这 
些 已 有 知识 。 特 别 是 当 机 器 人 移动 时 ， 传 感 器 数据 应 


该 以 可 预知 的 方式 变化 。 因 此 ， 如 果 传 感 系统 合适 的 


统计 特征 可 用 ， 可 以 采用 预测 修正 子 方法 例如 凯 尔 曼 
滤波 中 5 或 者 连续 关键 取样 “”… 。 如 果 存 在 数据 关 
联 问题 ， 可 以 采用 一 系列 通用 技术 例如 EM) Be 
前 述 的 预测 修正 子 方法 的 变种 “2 。 

偶尔 无 意义 的 数值 往往 造成 传感器 数据 损坏 ， 例 
如 ， 因 为 反射 的 存在 ,我 们 范例 中 的 激光 测 距 仪 可 能 
偶尔 会 返回 错误 的 范围 度数 。 许 多 常用 的 估计 技术 对 
所 谓 的 数据 离 群 值 并 不 具 鲁 棱 性 。 在 这 种 情况 下 ， 和 鲁 
棒 统 计 类 方法 “” 可 以 用 来 提高 传 感 和 估计 系统 的 
性 能 。 

最 后 ， 我 们 可 能 要 考虑 对 当前 的 任务 而 言 哪些 信 
息 是 重要 的 。 上 述 方法 中 大 多 数 都 假定 目标 是 要 产生 
与 当前 数据 本 身 密切 相关 的 一 系列 连续 参数 的 准确 估 
计 。 然 而 ， 在 某 些 任务 中 ， 我 们 对 参数 值 本 身 可 能 并 
不 感 兴 趣 。 人 和 例如， 假设 我 们 机 器 人 的 目标 是 通过 一 个 
门口 ， 虽然 这 明显 取决 于 估计 门 宽度 《一 个 连续 参 
数 ) 的 能 力 ， 最 终 的 决策 具有 二 分 性 。 该 问题 可 整 
理 为 一 个 决策 问题 。 而 决策 问题 可 以 使 用 决策 理 
论 站 的 概念 来 进行 模拟 ， 包 括 零 一 损失 闷 数 ， 似 然 
比 , 或 概率 比率 。 例 如 ， 在 机 胡 人 通过 门口 问题 中 ， 
如 果 任 务 的 优先 级 低 ， 与 其 试图 通过 一 个 太 小 的 缺口 
( 冒 着 损坏 机 器 人 或 门 ， 或 两 者 的 危险 ) ， 不 通过 该 


特定 的 门 〈 需 要 重新 寻找 替代 路 线 ) 相对 成 本 可 能 
更 低 。 反 之 ， 如 果 任 务 紧 急 ， 可 以 容许 机 器 人 采取 更 
加 危险 的 行为 。 

对 于 任何 给 定 的 任务 (或 决策 ) ， 决 策 所 需要 的 
信息 量 可 能 会 有 所 不 同 ， 例 如 ， 如 果 门 口 很 宽 ， 机 器 
人 只 需要 相对 少量 信息 就 可 以 安全 地 通过 。 反 之 ， 如 
果 门 口 很 罕 ， 机 第 人 作出 决定 前 需要 仔细 检查 。 确 定 
作出 某 项 判断 所 需 的 信息 类 型 和 数量 这 一 问题 有 不 同 
的 称谓 ， 顺 序 抽样 问题 “” ， 传感器 控制 问题 ， 或 传 
感 器 规划 问题 “”” 。 


拟人 估计 


在 我 们 的 机 器 人 定位 范例 中 ， 有 几 种 情况 下 问题 
的 关键 是 要 估计 出 一 个 可 表示 为 向 量 空间 中 的 一 个 点 
的 未 知 数量 。 例 如 二 维 (2-D) 或 者 三 维 (3-D) 点 


4.3.1 


的 位 置 或 者 机 器 人 的 位 置 。 还 有 的 情况 下 ， 问 题 是 确 
定 机 器 人 的 姿势 (位 置 和 方向 )， 或 者 一 条 线段 的 参 


数 。 后 者 的 不 同 点 在 于 其 参数 空间 不 属于 向 量 空间 ， 
这 会 引 人 一 些 额 外 的 独特 问题 。 进 一 步 的 讨论 我 们 推 
荐 读者 阅读 文献 (4.24, 25], HER RB RABI K 
们 将 只 讨论 向 量 空间 上 的 点 估计 问题 。 在 我 们 的 讨论 
中 ， 我 们 假设 读者 熟悉 多 元 高 斯 分 布 “” 和 初等 线性 
代数 “” 。 

本 节余 下 部 分 中 ， 

给 定 : 观察 模型 : 

y=f(x, 7) (4.2) 

tiit: xe Re(n) ， 基 于 观察 ye Re(m) ，7 为 未 
知 干扰 ， 其 值 为 Re(k); f HA Re(kt+n)  Re(m) 
的 已 知 映射 。 

我 们 的 讨论 分 为 两 个 主题 区 域 : 

1) 当 f 耻 为 线性 时 ， 对 成 批 和 顺序 数据 的 估计 
方法 。 

2) 当 f 耻 为 非 线 性 时 ， 对 顺序 数据 的 估计 方法 。 

1. 当 上 为 线性 时 ， 对 成 批 和 顺序 数据 的 估计 方法 

本 节 我 们 讨论 对 顺序 数据 的 线性 和 非 线 性 估计 方 
法 ,包括 凯 尔 曼 滤 波及 其 扩展 。 我 们 的 目的 是 提供 现 
有 方法 的 概述 。 更 多 信息 ， 读 者 可 参考 更 深入 的 相关 
文献 ， 例 如 文献 [4.16, 28, 29] 和 第 25 章 。 

我 们 首先 考虑 式 (4.2) 中 为 线性 的 情况 。 在 
该 情况 下 


我 们 考虑 如 下 基本 问题 。 


y = Fx + B) (4.3) 
FeRe(mxn) 定义 未 知 量 x 与 观察 量 y 之 间 的 〈 线 
性 ) 关系 ,Be Re(m xn)。 我 们 暂时 略 过 B 并 假设 
7 代表 系统 的 完整 干扰 模型 。 


用 最 小 二 乘 方法 由 y 来 估计 *， 需 要 求解 下 列 优 
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r > OO O 


化 问题 
(4.4) 


当 且 仅 当 和 矩阵 下 为 满 秩 ， 该 优化 问题 存在 唯一 解 人 。 
此 时 ,求解 如 下 线性 系统 可 得 到 优化 问题 的 解 . 
F'Fx =F'y (4.5) 
在 某 些 情况 下 ， 有 理由 相信 部 分 观测 元 素 比 另外 
的 元 素 更 可 靠 ， 因此 对 最 终 的 估计 应 该 贡献 更 多 。 可 
以 修改 式 (4.4), 包含 一 个 对 角 正 定 加 权 和 矩阵 来 整 
合 这 类 信息 


min || Fx ~y|P 


min( Fx —y)"W( Fx ~y) (4.6) 
求解 下 列 等 式 可 得 到 解 
(F°WF)x =F" Wy (4.7) 


BAR (4.3) 包含 了 干扰 项 (用 n 表示 )， 式 
(4.5) 或 者 式 (4.7) 并 没有 直接 用 到 该 数量 。 但 
是 ， 我 们 通常 可 以 用 统计 模型 来 模拟 传感器 的 噪声 特 
征 ， 调 整 原本 的 估计 问题 来 整合 该 信息 。 常见 的 一 种 
方法 是 极 大 似 然 估计 (MLE) 法 ， 得 到 的 全 值 ， 满 足 

p(y |%) =maxp(y | x) (4.8) 
对 于 式 (4.3) 代表 的 线性 附加 模型 ， {WER PR BAY FA 
特别 简单 的 形式 表达 。 假设 ?了 用 固定 已 知 的 概率 密 
度 函 数 刀 来 表示 ， 似 然 函数 可 表示 为 

p(y |x) =D(y - Fx) (4.9) 

MLE 与 前 面 提 到 的 最 小 二 乘 方法 相关 联 。 假 设 
n~N(O, A), NW 代表 均值 为 0， 方差 为 A 的 多 元 高 
斯 密度 函数 。 观 察 可 知 ， 最 大 化 似 然 函 数 的 值 等 效 于 
最 小 化 似 然 函数 的 负 自然 对 数 ， 一 系列 简短 的 计算 表 
明 ,， 取 WW=A” 时 的 加 权 最 小 平方 可 计算 得 到 优化 的 
最 大 似 然 估 计 。 

最 后 ， 有 些 参 数 比 其 他 的 更 容易 预知 。 例 如 ， 当 
观察 一 辆 汽车 在 高 速 公路 上 行使 时 ， 每 小 时 60mile 
的 速度 比 20mile 或 者 300mile 更 可 能 发 生 。 该 信息 可 
通过 对 未 知 变量 x 的 预先 统计 来 获取 。 

给 定 x 上 的 先 验 概率 密度 p(x)， 由 贝 叶 斯 理论 
可 知 
ply|x)p(x) _ p(y|x)p(x) 

Py) [p(y |x)p(x) dx 


(4. 10) 


pla|y) = 


最 大 后 验 概率 (MAP) fA x Re 
p(x |y) =maxp(x|y) (4.11) 
一 般 而 言 ， 该 优化 问题 的 解 可 以 非常 复杂 。 与 其 
进一步 探求 该 过 程 ， 我们 考虑 一 种 替代 方案 。 也 就 是 
说 ， 如 果 P(x|y) 的 二 阶 矩 存在 ， 通 过 求解 下 列 包含 
RAR 8 的 优化 问题 有 可 能 以 统计 学 方式 生成 最 小 








SHRI 
mink laly) -x (4. 12) 
也 就 是 说 ， 最 优 函 数 5 是 由 7 产生 的 具有 最 小 均 方 误 
Z (MMSE) 的 * 估计 。 因此 估计 子 8 通常 也 称 为 最 
小 均 方 误差 估计 子 。 
可 以 证 明 ， 在 一 般 情况 下 ， 优化 决策 法 则 6 为 
条 件 均值 * ”| 。 
6 (y) =E[x|y] (4. 13) 
遗憾 的 是 ， 如 同上 面 定义 的 MAP 估计 ， 该 表达 式 
在 一 般 情 况 下 计算 极其 困难 。 稍 后 我 们 考虑 计算 式 
(4.13) 的 近似 值 。 现 在 我 们 再 次 考虑 之 前 式 (4.3) 
所 代表 的 线性 观察 模型 (去除 BB), IEA, 我 们 假设 x 
和 和 ”为 二 阶 矩 有 限 的 独立 随机 变量 ,均值 都 为 0。 请 
注意 后 者 并 不 是 真正 的 约束 ， 因 为 它 可 以 通过 简单 定 
义 一 个 新 变量 *' =x - E[x] 来 实现 。 最 后 ， 我 们 只 考 
TEX PERRI 6, BREM, RITU % -8(y) = Ky, 
式 (4.12) 可 以 扩展 为 
Elle(y) -xl =E||Ky -x|P 
=E||K( Fx +n) -x| 
=E|| (KF -1)x|P +E\|Ky|P 
=tr| (KF -1)A (KF -I)"+K3K"] 
(4.14) 
此 处 ， 因 为 x 和 ?彼此 独立 ， 并 且 它 们 的 均值 都 
为 零 ， 所 以 有 几 项 被 消除 。 最 后 一 步 推 导 利 用 了 
lal =er(ua"), 
XY KORG, FRIES, TUTAE 
K=AF'(FAF'+3)7 (4.15) 
因此 ， 在 这 种 情况 下 ,最 优 估计 是 观测 值 的 线性 孙 
数 ， 线 性 项 只 依赖 于 随机 变量 以 及 定义 观测 系统 的 线 
性 项 的 方差 。 
如 果 x 的 均值 上 不 为 零 ， 不 难得 到 优化 估计 为 
t=Ky+(T-KF)L (4. 16) 
估计 的 方差 4: 为 
A* =(I-KF)A (4.17) 
感 兴趣 的 读者 可 能 希望 得 到 一 些 简化 情况 下 的 解 ， 例 
W, MRA=L, F=1, K=1/U, 那么 和 =y + 为 
简单 均值 ， 方 差 为 4!+ =1/24。 
2. 卡尔 曼 滤 波 
AS ERR, 我们 接 下 来 定义 线性 系统 的 离散 
时 域 卡尔 癌 - 布 西 滤波 “” 。 考 虑 下 述 时 序 模型 
(4. 18) 
y= Fx, +7, (4. 19) 
AP, G 是 描述 系统 时 间 变 化 的 nxn SERRE; x RDA 
均值 为 x), WA 4o 的 高 斯 分 布 。 并 且 ，w Al 7,48 


Keel = Gx, +w, 
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对 于 所 有 时 间 上 上 均 为 零 均 值 高 斯 独立 随机 变量 ， 对 于 
MA tt, wF w, GLAM, HFA t*r, 
NnF no BUR, 1 FHRAD,, w AHH O,. 
给 定 一 个 观测 y, AT AES, WE 
出 方差 为 A 的 新 的 估计  。 注 意 ， 解 为 两 个 高 斯 随 
机 变量 的 线性 组 合 : 观测 值 y 以 及 之 前 的 佑 计 值 %。 
涯 为 任何 高 斯 随机 变量 的 线性 组 合 仍 为 高 斯 随机 变 
量 ， 所 以 更 新 后 的 估计 仍 服从 高 斯 分 布 。 
现在 我 们 通过 动态 模型 进行 投影 。 为 便于 描述 ， 
用 上 人 角 标 减 号 和 加 号 分 别 代表 估计 步骤 之 前 与 之 后 。 
A, RETAN A 的 估计 x”， 往 前 一 步 时 间 的 投 
影 结 果 为 
%,., = Gx; (4, 20) 
A,,, =GA; G" +Q, (4.21) 
此 时 ， 系 统 获 取 到 一 次 新 的 观测 y,,, ， 上 述 步 又 开始 
循环 重复 。 图 4. 11 总 结 了 线性 系统 完整 的 卡尔 曼 滤 
波 算法 。 











Ai FFA m FE f 
U-KnPAm | 


图 4.11 卡尔 曼 滤 波 算法 小 结 


可 以 证 明 在 给 定 假 设 条 件 下 ， 卡 尔 曼 滤 波 为 均 方 
优化 滤波 。 在 其 中 一 个 或 者 两 个 高 斯 分 布 假设 不 成 立 
的 情况 下 卡尔 曼 滤 波 仍 为 优化 线性 滤波 。 

3. 连续 数据 的 非 线 性 估计 方法 

于 一 节 的 结果 假设 观测 值 与 系统 状态 ， 附 加 噪声 
之 间 的 关联 为 线性 形态 ， 系 统 的 状态 变化 也 可 用 线性 
关系 来 表述 。 并 且 ， 对 于 观测 值 服 从 高 斯 分 布 ， 噪 声 
具 传 递 性 的 系统 ， 该 结果 为 全 局 最 优 : 如 果品 声 源 为 
非 高 斯 分 布 ， 则 该 解 仅 为 最 优 线性 估计 子 。 

正如 一 开始 提 到 的 ， 更 通用 的 非 线 性 〈 离 散 时 
E) 系统 描述 为 

Xl =8,(%,) +, 
¥, Efix) +n, 
KE, RA Em. 


(4.22) 


虽然 该 模型 含有 非 线性 项 ， 对 当前 估计 的 非 线性 
项 进行 泰勒 级 数 展开 ， 仍 可 能 应 用 卡尔 曼 滤波 的 变 体 
形式 ， 即 扩展 卡尔 曼 滤 波 (EKF)。 用 J 代表 函数 / 
的 雅 可 比 和 矩阵 。 假 设 时 步 为 二 -1 时 估计 存在 ， 式 
(4.22) 在 该 点 的 一 阶 扩 展 为 


Nis! =8,(%,_1) + Je (%,1) Cx, 一 和 1) +w, (4. 23) 


Y, =f, (Zei) + J, (x-2) + 7, (4. 24) 
加 以 整理 可 得 到 适合 之 前 定义 的 卡尔 曼 滤波 的 线性 
形式 


~ ~ A A 
Mie Xa -g (%1) +I, r-i =J,%, +w, 


(4.25) 

7 = 入 Sa) +081 =x, +n, (4, 26) 
式 (4.25) 和 式 (4.26) P, z 与 y 为 新 的 合成 状 
态 和 观测 变量 ，/] 扮演 G 的 角色 , R F 的 角色 。 

值得 注意 的 是 ，EKF 迭代 在 本 质 上 是 一 种 加 权 
牛顿 迭代 ， 即 一 种 循环 非 线 性 估计 方法 。 因 此 ， 保 
持 方 差 固定 ， 对 同一 观测 进行 多 次 循环 是 有 用 的 。 
这 样 ， 当 大 的 干扰 或 者 严重 的 非 线 性 存在 时 ， 估计 
子 可 以 收 钱 得 到 解 。 只 有 收 钙 以 后 ， 才 会 更 新 方差 
项 。 这 种 卡尔 曼 滤 波 被 称 为 迭代 扩展 卡尔 曼 滤波 
(JEKF) 。 


4.3.2 其 他 估计 方法 


在 前 一 节 ， 我 们 回顾 了 最 常见 和 广泛 应 用 的 估计 
方法 。 然 而 ， 还 有 几 种 蔡 代 方法 可 求解 参数 估计 问 
题 。 这 里 我 们 简单 介绍 两 种 : 连续 关键 取样 和 图 形 
模型 。 

1. 连续 关键 取样 

在 此 之 前 的 讨论 都 集中 在 用 估计 的 均值 和 方差 来 
近似 计算 系统 状态 。 有 一 种 利用 贝 叶 斯 定理 的 替代 方 
法 ， 其 一 般 表 达 式 为 

DC yy -2O Ya Ye bn Pe) 

mente ase PCN» Yaya) 
(4.27) 

假设 y, 独 立 于 之 前 的 所 有 观测 与 给 定 的 系统 状 
态 x, ， 给 定 x,_| 的 情况 下 ， 当 >1， zx, 独立 于 x,_,, 
该 表达 式 可 简化 为 
_PC Len PCH, lani) 


p(s, EA s Yn) = ply lx.) (4.28) 
另外 ， 由 条 件 均 值 可 得 到 最 优 均 方 估 计 ， 即 
6° (y,) =Elx, ly] (4. 29) 


实际 上 ， 我们 充分 证 明了 卡尔 曼 滤 波 是 该 结果 在 含 高 
斯 干扰 的 线性 系统 情况 下 的 特例 。 

通常 情况 下 实现 该 过 程 的 难点 最 终 转化 为 在 非 线 
性 、 非 高 斯 形态 的 情况 下 进行 表征 和 计算 分 布 的 问 
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题 。 但 是 ， 如 果 假 设 之 前 的 连续 变量 * 取 值 仅 为 离 
散 数 集 ， 那 么 计算 贝 叶 斯 定理 和 其 他 相关 统计 量 就 简 
化 为 基于 该 离散 数 集 的 直接 计算 。 这 对 于 任何 分 布 和 
任意 转换 都 可 简单 实现 。 

连续 关键 取样 〈 也 称 为 粒子 滤波 ， 凝 聚 等 其 他 
BF) 是 用 统计 学 来 处 理 该 问题 的 一 种 方法 。 为 进 
行 连续 关键 取样 ， 作 如 下 假设 ; 

1) FAY MALS PRK p(y, | x, ) 进行 取样 。 

2) 可 从 动态 模型 pla, | x,_,) 进行 取样 。 

注意 取样 的 重点 : 不 需要 显 式 地 展示 似 然 函 数 或 
者 动态 模型 的 解析 形式 。 

给 定 以 上 假设 ， 连 续 关 键 取样 的 最 简单 形式 可 以 
FA: 

1) H m,i = | <xr u>, k=1, 2, N} 
代表 一 系列 样本 点 x:.,， 权重 为 wt_, 且 满足 
Ew i=l, 

2) 计算 入 个 新 的 采样 mi = | <x, N>, 
k=1, 2, +N}, 

中 按照 与 权重 ow! BRIE E WG BE YE R RE 
FR Xo 10 

D 给 定 x, MN I/N, M P(x, |x*_, ) 取样 。 

3) tt rm, = | < xi, P(y, |x) >, k=l, 
2, Ni 
很 容易 看 出 以 上 步骤 为 循环 滤波 的 形式 。 而 且 ， 在 任 
意 时 刻 ， 相 关 分 布 的 任何 统计 量 可 从 样本 集 和 相关 权 
重 来 近似 计算 。 

这 种 形式 的 基于 取样 的 滤波 广泛 应 用 于 用 线性 估 
计 技 术 不 足以 处 理 的 各 种 挑战 性 领域 。 这 些 线性 估计 
技术 对 于 低 状态 维度 (通常 n<3) 和 动力 学 约束 完 
备 的 问题 特别 有 效 。 对 于 高 维 问题 或 者 展现 高 动态 变 
化 的 系统 ， 要 获得 好 的 近似 所 需要 的 粒子 数量 会 太 大 
以 至 于 实际 上 不 可 能 实现 。 然 而 ， 即 便 是 这 样 ， 有 时 
还 是 可 以 应 用 基于 采样 的 系统 来 产生 可 以 接受 的 
结果 。 

2. 图 形 模 型 

图 形 模 型 代表 一 系列 变量 之 间 依 赖 与 独立 关系 的 
一 类 模型 。 常 见 的 图 形 模 型 范例 包括 贝 叶 斯 网 、 影 响 
图 和 神经 网 。 这 里 我 们 以 贝 叶 斯 网 为 特别 范例 来 重点 
讲述 。 

贝 叶 斯 网 络 属于 有 向 无 环 图 ， 用 节点 代表 随机 变 
量 ， 用 有 向 弧 代 表 随 机 变量 对 之 间 的 概率 关系 。 用 父 
TA (X) 代表 所 有 弧 中 止 于 忒 的 节点 集合 ， 并 用 
Mi, Xo, +, ,代表 图 中 的 NN 个 随机 变量 。 我 们 有 
以 下 公式 


N 
PCX, XQ 5°°,Xy) = [[ P(X; | parents(X,)) 
i=] 


(4. 30) 

作为 范例 ， 图 4. 12 所 示 的 贝 叶 斯 网 络 代表 一 个 

执行 定位 任务 的 移动 机 器 人 。 该 图 形 模 型 表征 问题 的 

时 序 形态 ， 因 此 属于 链 式 网 络 。 有 关 这 类 模型 的 更 多 
讨论 ， 请 参考 文献 [4.31], 





图 4. 12 ”表征 机 器 人 定位 的 图 形 模型 示例 


由 叶 斯 网 络 的 结构 可 代表 变量 之 间 的 各 种 独立 关 
系 。 人 研究 这 些 独立 关系 可 以 设计 出 有 效 的 推理 算法 。 
万 其， 无 环 图 即便 是 采用 无 向 形式 (KALB) 时 
也 兼容 线性 推理 算法 。 更 通用 的 图 可 用 多 种 循环 迭代 
方法 求解 。 特 别 是 ， 如 果 网 络 中 的 分 布 是 连续 形式 ， 
连续 关键 采样 的 变 体 可 用 近似 方法 来 求解 问题 “2 。 


4.3.3 鲁 棒 估计 方法 


在 前 面 的 论述 中 ， 我 们 一 般 性 地 假设 所 有 的 数据 
都 是 “好 的 "， 意 味 着 数据 即便 是 因 干 扰 而 损坏 ， 但 
最 终 仍然 携带 当前 问题 的 信息 。 然 而 ， 在 许多 情况 
下 ， 数 据 可 能 含有 离 群 值 ， 要 么 跟 典 型 数据 相 比 损坏 
ME, 要么 完全 就 是 可 疑 的 数据 。 例 如 ， 在 我 们 的 地 
图 绘制 应 用 中 ， 我们 可 能 偶尔 会 收 到 经 过 了 多 次 反射 
回来 的 范围 数据 。 因 此 ， 当 扫描 一 道 直 墙 时 ， 大 部 分 
的 上 态 都 会 沿 一 条 直线 分 布 ， 但 偶尔 会 有 距离 值 完全 不 
一 致 的 数据 点 。 

问题 在 于 ， 许 多 常见 的 估计 方法 对 数据 离 群 值 非 
常 敏感 。 考 虑 一 个 简单 例子 ， 通 过 一 系列 观测 值 x,， 
42，…，Xw 来 估计 标量 xo BATA LF RT x 


a L X, 
x = > W (4.31) 
ARME, (BX, RRA. RATA BB Ee 
达 式 
2 - Sx Xe (4. 32) 
N 


不 难看 出 ， 通 过 改变 ,的 值 , 二 可 以 取 任何 值 。 简 而 言 
之 ,单个 离 群 数据 能 够 产生 任意 差 的 估计 。 更 一 般 地 
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说 ,任何 最 小 二 乘 问题 的 解 ， 例 如 从 激光 距离 数据 估计 
一 条 直线 ， 可 用 一 般 形式 x = My 表示 。 基 于 以 上 相同 的 
理由 ， 不 难得 出 任何 最 小 二 乘 解 都 易 受 离 群 值 的 影响 。 

鲁 棒 统 计 领 域 研究 的 是 当前 数据 被 离 群 值 污染 时 
的 优 计 或 者 决策 问题 。 鲁 棒 统 计 中 有 两 个 重要 的 概 
念 ， 届 服 点 和 影 啊 函数 。 屈 服 点 是 在 估计 过 程 中 估计 
子 不 产生 任意 大 误差 所 能 承受 的 离 群 值 (数据 具备 
任意 大 误差 ) 的 比例 。 我 们 认为 最 小 二 乘 方法 的 届 
服 点 为 0% ， 因 为 单个 观测 的 干扰 可 导致 估计 的 偏差 
ERL, HEWA, 我 们 也 可 以 取 数 据 的 中 间 值 来 计 
算 估计 ,这样 届 服 点 为 50% 一 一 即使 一 半 的 数据 为 
离 群 值 ， 仍 然 可 以 产生 有 意义 的 结果 。 

屈服 点 确定 可 以 承受 的 离 群 值 数 量 ， 而 影响 函数 
确定 一 个 离 群 值 对 估计 的 影响 程度 。 最 小 二 乘 情况 
下 ， 影 响 函数 为 线性 函数 。 创 建新 的 更 鲁 棒 性 估计 子 
的 一 种 方法 是 M 估计 “"”。 为 产生 M 估计 ， 我 们 考 
虑 下 列 最 小 化 问题 


min $ pQ, Yi) 
请 注意 , 定义 p(a, b) = (a -5) 导致 最 小 二 乘 解 。 


然而 ， 我 们 可 以 选择 其 他 对 离 群 值 阻 抗 更 好 的 果 数 。 
图 4. 13 给 出 了 3 个 常见 范例 。 





(4. 33) 








b) 


图 4.13 3 个 常见 范例 
a) 三 种 常见 的 鲁 棒 估计 函数 、 平 方 晒 数 、 绝 对 值 和 


图 基 双 权重 函数 Ob) 相应 的 影响 函数 


请 注意 ， 一 般 说 来 , A (4.33) 的 优化 是 非 线 
性 的 ， 通 常 不 存在 闭合 形式 解 。 有 趣 的 是 ， 用 重复 再 
加 权 最 小 平方 法 CIRLS) 来 求解 该 问题 通常 是 可 能 
Ay'* 78°41 IRLS 的 原理 很 简单 。 之 前 在 式 (4.7) 中 
我 们 引入 了 一 个 权重 矩阵 WW。 假 设 我 们 可 以 通过 某 种 
方式 知道 哪些 数据 点 是 离 群 值 。 在 这 种 情况 下 ， 我 们 
可 以 简单 地 将 这 些 点 的 权重 设 为 零 ， 得 到 的 结果 将 是 
HR (AER) 数据 的 最 小 二 乘 估计 。 

在 IRIS 中 ,我 们 交替 假设 离 群 值 (通过 再 加 
权 ) 和 求解 来 得 到 结果 (通过 最 小 二 乘 ) 。 通 常 ， 点 
的 权重 依赖 于 估计 的 残留 误差 。 假 设 我 们 计算 

r=y—Fx (4.34) 
& by) =dp/dx |;， 然后 我 们 可 以 设 WW ;= (yy)Vr,。 
可 以 证 明 ， 在 许多 情况 下 ， 这 种 形式 的 加 权 可 以 收 
Ko E4. 14 给 出 了 一 个 利用 IRLS 技术 进行 视频 追踪 
的 范例 。 





a) | b) c) 


图 4.14 用 IRLS 实现 的 M 估计 来 进行 视频 追踪 的 范例 4! 
a) 单 帧 视频 的 人 脸 追 踪 结 果 (黑色 边框 对 应 没有 剔除 
离 群 值 的 追踪 算法 ， 白 色 边 框 则 对 应 于 剔除 了 异常 值 的 
算法 。) b) 白色 边框 内 区 域 的 放大 图 c) 相应 的 权 

BMA (黑色 的 区 域 代表 异常 值 。) 


另外 一 种 处 理 离 群 值 的 常用 方法 是 基于 表决 的 
方法 ， 即 选择 一 系列 数据 然后 对 结果 进行 表决 。 我 
们 讨论 两 种 常用 的 方法 : RANSAC“* ”和 最 小 均 方 
(LMedS) 435] 。 

在 两 种 情况 下 ， 我 们 都 从 这 样 的 一 个 概念 开始 ， 
即 在 所 有 数据 (包括 离 群 值 ) 中 ,存在 一 个 与 好 的 
数据 相 一 致 的 估计 。 问 题 演 变 为 如 何 选 出 该 估计。 考 
虑 我 们 之 前 的 问题 ， 即 从 激光 数据 估计 一 条 直线 ， 并 
假设 我 们 拥有 100 个 激光 点 。 我 们 真正 需要 的 是 正确 
选 出 两 个 点 ， 匹 配 出 一 条 直线 ， 然 后 记录 其 他 点 有 多 
少 是 与 该 直线 相 一 致 的 。 如 果 我 们 (保守 地 ) 估计 
3/4 的 数据 是 好 的 ， 那么 选 出 两 个 好 的 点 的 几率 是 
9/16， 或 等 效 于 有 一 个 或 两 个 点 为 离 群 值 的 几率 是 
7/16。 如 果 我 们 重复 该 步骤 数 次 (例如 10 x), AB 
么 我 们 所 有 的 选择 均 为 差 的 几率 是 (7/16)”= 
0.025% 。 换 种 说 法 ， 有 99.975% 的 几率 我 们 已 经 选 
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择 了 一 个 好 的 点 对 。 

我 们 如 何 决 定 接受 一 个 采样 9 在 RANSAC th, 
我 们 对 在 给 定 的 距离 临界 值 内 与 估计 相 一 致 的 采样 数 
目 进 行 计数 来 进行 表决 。 例 如 ， 我 们 选择 那些 距 我 们 
估计 出 的 直线 某 一 固定 距离 以 内 的 点 。 在 LMedS th, 
我 们 则 计算 所 有 采样 点 与 直线 之 间 的 距离 中 值 。 然 后 
我 们 选取 具有 最 小 中 值 的 估计 。 

不 难看 出 LMedS 有 一 个 届 服 点 是 数据 取 值 的 
50%. A—TFi ti, RANSAC 的 一 个 屈服 点 能 够 更 大 ， 
但 是 这 需要 选择 临界 值 。RANSAC 还 具备 这 样 一 项 优 
势 ， 一 旦 确定 了 非 离 群 值 ， 可 以 从 非 离 群 值 计算 最 小 
均 方 估计 ， 因 此 可 以 降低 估计 中 的 干扰 。 

RANSAC 和 LMedS tH A] Ll AER IT HE, Fil 
如 IRLS， 提 供 好 的 初始 解 。 


4.3.4 数据 关联 技术 


上 一 节 考 虑 的 情况 是 在 观测 值 与 待 估计 量 之 间 存 
在 某 一 已 知 的 关联 。 然 而 ， 正 如 在 我 们 最 初 的 移动 机 
信人 地 图 问题 中 所 说 明 的 ， 有 的 情况 下 除了 估计 外 ， 
我 们 需要 同时 计算 这 个 关联 本 身 。 在 这 种 情况 下 ， 佑 
计 中 的 一 个 必要 步骤 就 是 数据 关联 问题 : 得 到 观测 数 
据 与 待 估计 量 之 间 的 相关 性 。 

有 很 多 关于 这 个 问题 的 文献 ; 这 里 我 们 主要 讨论 
儿 种 广泛 应 用 的 特定 方法 。 我 们 的 讨论 将 分 为 通常 用 
于 时 序数 据 滤波 的 散 ( 或 称 顺序 ) 关联 方法 ， 和 有 
完整 的 数据 可 供 处 理 时 使 用 的 非 散 (或 称 为 批 ) 关 
联 方法 。 后 者 常用 数据 分 组 方法 来 处 理 。 

在 这 两 种 情况 下 ， 我 们 可 以 向 数据 源 引 入 不 确 
定 度 来 扩展 之 前 的 模型 和 定义 。 为 此 ， 我 们 将 在 数 
据 上 用 上 标 来 表示 观测 模型 。 因 此 ， 我 们 的 观测 模 
型 变 成 


Xe | =g,(«*) + ws (4, 35) 
yi =f (at) + (4. 36) 
此 人 处 k=1...M, 
1. 成 批 数据 分 组 


按照 之 前 进行 点 估计 的 相同 步 又， 我 们 首先 考虑 
对 数据 完全 不 做 任何 统计 假设 ， 系 统 动力 学 也 未 知 的 
情况 。 因 此 ， 只 有 观测 值 y, ，y, ，…，yw 给 定 。 未 知 
参数 为 x, ，x, ，…，xn (我 们 暂时 认为 六 为 已 知 ) 。 
我 们 的 目标 是 计算 关联 映射 了 ， 使 得 当 且 仅 当 模型 参 
数 和 中 出 现 了 时, mU) =k, 

2. 天 均值 聚 类 

用 于 分 组 和 数据 关联 的 k 均值 算法 简单 ， 且 广 为 
接受 ， 因 此 是 我 们 讨论 的 一 个 好 的 起 点 。 这 里 ， 我 们 
假设 f(x) =x， 也 就 是 说 ， 提 供给 我 们 的 是 当前 状态 


丫 量 的 含 干扰 观测 值 。 然 后 ， 如 下 应 用 均值 算法 . 

1) 选取 六 个 数据 簇 的 中 心 |!) 。 

2) 对 于 每 一 观测 值 yy， 将 它 与 最 临近 的 簇 中 心 
相关 联 ， 也 就 是 说 , Or) =i, IRRE RN d 
(通常 为 欧 几 里 德 距离 ) 满足 

d(x‘, y;) =mind(2 ， y;) (4.37) 
3) 估计 与 每 一 簇 中 心 相 关联 的 观测 的 均值 
a (4. 38) 


x= DY, 
i,m) =i 


4) 重复 步骤 2) 和 3)。 

在 许多 初始 化 良好 的 情况 下 ,& 均值 工作 得 很 
好 。 但 是 ， 该 方法 不 能 生成 合适 的 簇 ， 也 不 能 保证 能 
收敛 得 到 解 。 因 此 ， 常 见 的 做 法 是 ， 以 不 同 的 初始 条 
件 重复 该 算法 几 次 再 挑 取 最 优 的 结果 。 也 请 注意 ， 通 
过 定义 

d(x,y) = ||Fx' -y |l (4. 39) 

在 式 (4.3) 中 引入 不 ， 并 用 相应 的 最 小 二 乘 估计 子 
SR (4.38) 可 以 直接 扩展 线性 观测 模型 。 进 一 
步 说 ， 如 果 我 们 有 观测 数据 的 统计 模型 ， 那 么 我 们 可 
以 利用 之 前 定义 的 似 然 函 数 ， EdC, y) = 
p(y, l3), HAJER (4.38) 中 的 MLE, 

均值 算法 的 一 个 局 限 是 即使 我 们 已 知 统计 模 
型 ， 也 不 保证 一 定 收敛 。 但 是 ， 该 方法 的 一 个 变 体 ， 
称 为 期 望 最 大 化 ， 可 被 证 明 收敛 。 

3. 数据 关联 的 期 望 最 大 化 与 模拟 

期 望 最 大 化 (EM) 算法 下 是 一 种 用 来 处 理 数 
据 丢失 的 通用 统计 技术 。 在 前 面 的 讨论 中 ， 给 定 未 
知 参 数 集 ， 我 们 用 最 大 似 然 估 计 来 最 大 化 观测 数据 
的 条 件 概率 。 但 是 ， 使 用 MLE 时 我 们 假设 数据 完全 
已 知 。 特 别 是 ， 我 们 知道 数据 成 分 与 模型 之 间 的 
关联 。 

现在 让 我 们 假设 部 分 数据 丢失 。 为 此 ， 分 别 定义 
o 和 六 ,为 观测 数据 和 非 观测 数据 。 然 后 我 们 可 以 写 

PCY Hy |æ) =p( Yy | Yo x) pC¥, | x) (4. 40) 


假设 现在 我 们 给 定 猜测 +*， 并 有 关于 未 知 数据 Yu 的 一 
个 分 布 【 下 面 马上 将 会 讨论 这 一 点 ) 。 我 们 可 以 计算 
对 数 似 然 函 数 的 期 望 值 (之 前 提 到 过 最 大 化 对 数 似 
然 值 等 同 于 最 大 化 似 然 值 ) 为 
Q(x ,x) = Ey | logp( Yo Oy | x) [Zo x | (4. 41) 

注意 我 们 区 分 * 为 固定 量 ， 通 常 需要 定义 其 在 未 知 数 
据 上 的 分 布 ， 而 未 知 量 x 为 对 数 似 然 函数 。 

理想 情况 下 ， 我 们 接 下 来 可 以 选择 x 的 数值 使 得 
0 最大。 因此， 根据 迭代 法 则 ， 我 们 可 以 选择 一 个 新 
的 值 : 
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x; = arg maxQ(x,%,_,) (4.42) 
R LERH, EREK SAT H AR OO 的 局 部 
最 大 值 。 但 是 值得 注意 的 一 点 是 ， 不 能 保证 该 最 大 值 
为 全 局 最 大 值 。 
如 何 将 其 与 数据 分 组 相关 联 ? 我 们 考虑 观测 数据 
即 为 已 观测 到 的 数据 。 设 未 观测 到 的 数据 为 关联 值 
mC), j=1, 2, =M 确定 观测 数据 所 来 目的 模型 。 
请 注意 它 是 一 个 离散 随机 变量 。 进 一 步 假设 有 NN 个 
数据 簇 服从 高 斯 分 布 ， 均 值 为 x,， 方 差 为 A;。 设 一 
个 特定 数据 项 y, 来 自 于 第 i 簇 的 无 条 件 概率 为 ao Ñ 
知 参 数 为 8 = [x t, e, Zy, Ay, Ar, oo, Ay, 
Ql ，Q2，*"…，Qw1。 RNA -和 + 来 分 别 表示 先 验 参 
数 估 计 和 更 新 的 参数 估计 。 基 于 简明 的 目的 ， 我们 也 
定义 wj;=p(7 =i|y;，0)， 并 用 下 标 + 来 表示 更 新 
的 参数 估计 。 然 后 ， 经 过 一 系列 计算 推导 ， 数 据 分 组 
的 EM 算法 变 为 
五 -步骤 : 


ply, | m(j) =i,0)a; 





u Epl lar) =i,0)a, (1409 
M- 步 又 : 
= D ywy D, wy (4. 44) 
= tpl se (4. 45) 
= dn MK 之 È s (4.46) 


从 上 述 推 导 可 以 看 出 EM 算法 产生 的 是 一 种 软 分 组 ， 
相反 ,上 均值 产生 的 是 观测 值 从 属于 哪 一 个 数据 簇 的 
确定 性 决策 (用 w ,表示 )。 实 际 上 ,估计 的 结果 是 
高 斯 混合 模型 的 最 大 似 然 估计 ， 可 如 下 表示 


p(y|10) = D&N |3 A) (4.47) 
此 处 N(. ) 代表 一 个 高 斯 密度 函数 。 图 4. 15 给 出 
了 对 从 高 斯 混合 模型 取样 的 数据 执行 EM 算法 的 
结果 。 





图 4.15a-d 期 望 最 大 化 分 组 示例 ( 图 例 为 第 1， 第 2， 第 5 和 第 10 次 循环 的 结果 ) 


4. 递归 滤波 
在 上 述 的 批 处 理 方法 中 ， 我 们 预先 并 不 知道 状态 
参数 的 信息 。 进 行 递归 滤波 时 ， 有 利 的 是 我 们 在 时 刻 


yi, i= N, 问题 是 确定 映射 7: |1… 
M} ， 将 数据 元 素 i 与 模型 k=m(i) 相关 联 。 在 某 些 


t+) 已 知 状态 估计 和 和 A;。 和 之 前 一 样 ， 对 于 数据 
N}—>{ Lo 
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情况 下 ， 包 含 一 个 离 群 值 过 程 以 处 理 来 自 于 未 知 模型 
的 数据 是 有 益 的 。 为 此 ， 我 们 可 以 在 函数 范围 内 包含 
零 值 ， 并 把 零 映射 作为 离 群 值 。 

s， 最 近邻 关联 

类 似 于 上 均值 分 组 ， 产 生 数 据 关 联 的 一 种 简单 方 
式 是 如 下 计算 数据 关联 值 

w(i) = arg mind ( F's’, y') (4. 48) 

然而 ， 最 近邻 方法 并 不 考虑 我 们 关于 传感器 数据 或 者 
佑 计 的 已 知 信息 。 也 就 是 说 ， 我 们 可 能 对 模型 ;有 -- 
个 非常 好 的 估计 ， 而 对 另外 的 模型 有 一 个 非常 差 的 
估计。 如 果 传 感 器 对 两 者 等 距离 观测 ， 掷 硬币 决定 会 
有 意义 吗 ? 观测 来 自 于 模型 (其 方差 较 大 ) 比 模型 
i (AHAB) 更 有 可 能 。 

考虑 以 上 因素 的 一 种 常用 措施 是 马 哈 拉 诺 比 斯 距 
离 “”。 其 原理 是 根据 方差 来 对 每 个 数值 进行 加 
权 ， 即 

mY) ya) = (7, =y) CA; +A,) ~! (y 入) 

(4. 49 ) 
因此 ， 距 离 按 与 不 确定 度 成 反比 缩放 。 在 上 述 情况 
下 ,具有 较 高 方差 的 观测 将 产生 较 小 的 距离 ， 与 我 们 
设想 的 一 致 。 

即便 使 用 这 种 加 权 方 法 ， 我们 在 数据 关联 中 仍然 
可 能 犯错 。 从 估计 的 观点 来 看 ， 这 将 在 估计 过 程 中 引 
入 离 群 值 ， 如 上 所 述 ， 并 可 能 导致 很 糟 的 结果 。 另 外 
一 种 方法 ， 类似 于 IRLS， 基 于 与 模型 之 间 的 距离 来 
对 数据 加 权 。 这 就 很 自然 地 导致 了 数据 关联 滤波 的 概 
念 。 有 关 这 些 方法 的 更 广泛 讨论 ， 我 们 推荐 读者 阅读 
参考 文献 [4. 18] 。 


传感器 模拟 


全 此 ， 我 们 已 经 介绍 了 几 种 传 感 模式 ， 也 讨论 了 
几 种 佑 计 方 法 。 但 是 ， 后 者 通常 依赖 于 具备 前 者 的 统 
计 模 型 。 因 此 ， 有 关 传 感 器 模拟 的 简短 讨论 可 以 令 传 
感 与 估计 章节 更 加 完整 。 

设计 一 个 传感器 模型 涉及 四 个 主要 部 分 ，@D 创 立 
一 个 物理 模型 ; Qe RARE; 国 确 定 误差 模 
型 ; 识别 失效 条 件 。 

物理 模型 是 待 测量 (x) 与 可 用 数据 (y) 之 间 
的 关系 f。 在 许多 情况 下 ,该 关系 是 很 明显 的 ， 例 
如 ， 激 光 传 感 茵 与 环境 中 某 表面 之 间 的 距离 。 在 其 
他 情况 下 ， 该 关系 可 能 没有 如 此 上 明显, 例如， 多 幅 
相机 图 像 中 的 亮度 与 相机 至 观测 点 之 间 的 距离 这 两 
者 相关 联 的 正确 模型 是 怎样 的 ? 在 某 些 情况 下 ， 包 
含 计算 过 程 是 必要 的 ， 例 如 传感器 模型 中 的 特征 检 


4.3.5 





测 和 相关 性 。 

一 旦 确定 了 物理 模型 ,通常 有 一 个 传感器 标定 的 
步 又 。 该 步骤 一 般 特 定 于 所 使 用 的 传感器 ， 例 如 ， 透 
视 相 机 系统 的 图 像 几 和 何 要 求 识 别 两 个 缩放 参数 〈 主 
体 图 像 尺度 ) 和 光学 中 心 (两 个 额外 参数 ) 的 位 置 。 
通常 还 有 镜头 失真 参数 。 这 些 参 数 只 能 通过 仔细 的 标 
定 程 序 才 能 确定 “| 。 

一 旦 标定 好 的 物理 传感器 模型 可 用 ， 确 定 一 个 误 
差 模 型 通常 包含 统计 参数 的 识别 。 理 论 上 ， 第 一 步 是 
确定 一 个 误差 的 经 验 分 布 。 但是， 这 通常 是 很 困难 
的 ， 因 为 它 需 要 知道 未 知 参数 的 精确 的 地 面 真 值 。 这 
通常 需要 开发 一 个 可 模拟 所 期 望 的 传 感 情况 的 实验 
装置 。 

给 定 这 样 的 一 个 经 验 分 布 ， 还 有 了 风 个 重要 的 问 
题 ， 包括: 中 观测 在 统计 上 独立 吗 ? 国 误 差分 布 是 否 
单 峰 ? 地 经 验 误 差 的 关键 要 素 能 否 用 常见 的 统计 量 ， 
例如 数据 方差 .来 获取 ? 关于 该 主题 的 更 多 信息 ， 我 
们 推荐 读者 阅读 统计 与 数据 模拟 方面 的 书籍 (BS 
考 文献 [4. 38] ) 。 

最 后 ， 理 解 何 时 传感器 能 够 或 不 能 够 提供 可 靠 的 
数据 是 很 重要 的 ， 人 例如， 激光 传感器 在 黑暗 的 表面 上 
不 如 在 明亮 表面 上 精确 ， 光 照 太 亮 或 者 太 暗 相机 不 能 
生成 有 意义 的 数据 ， 等 等 。 有 时 ， 有 简单 迹象 可 判断 
这 些 情 况 的 存在 ， 例 如 ， 察 看 相机 图 像 的 强度 直方 图 
能 够 快速 断定 当前 条 件 是 否 适合 处 理 。 有 些 情况 下 ， 
只 能 在 背景 下 才 可 能 检测 到 这 些 状况 ， 例 如 ， 两 个 
忠 离 传感器 检测 到 的 与 某 表 面 的 距离 不 一 致 。 有 时 
失效 只 能 在 回溯 中 才能 诊断 出 来 ， 例 如 一 个 三 维 表 
面 模型 建立 后 ， 很 明显 ， 一 个 假设 的 表面 被 男 一 个 
所 阻 阳 ， 则 必定 有 多 重 反 射 存在 。 在 一 个 真正 鲁 棒 
的 传 感 系统 中 ， 应 该 用 所 有 可 能 的 方法 来 验证 传 感 
器 操作 。 


4.3.6 其 他 不 确定 性 管理 方法 


鉴于 篇 幅 所 限 ， 我 们 的 讨论 只 局 限于 最 常用 的 传 
感 和 估计 方法 。 值 得 注意 的 是 已 经 有 许多 其 他 的 替代 
性 不 确定 性 管理 方法 被 提出 来 并 成 功 应 用 。 

例如 ， 如 果 已 知 传 感 误 差 有 界 ， 那么 基于 约束 的 
方法 对 点 估计 很 有 效 “””]1。 或 者 ， 如 果 只 有 部 分 概 
率 模型 能 被 识别 ,， 可 用 丹 普 斯 特 - 谢 菲 方法 来 做 
决策 1 a 

FRE SLIT RAISE A AI A PR, EE 
合理 论 使 得 部 分 成 员 成 为 可 能 。 例 如 ， 在 数据 分 类 
中 ， 在 某 两 个 范畴 例如 “平均 ”与 “高 ”中 选择 可 
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能 很 困难 ， 但 是 用 逐步 切换 则 行 得 通 。 如 参考 文献 
[4.42] 所 述 ， 这 类 方法 已 用 于 DAMN 结构 的 情况 评 
佑 与 导航 。 


4.4 表示 方法 


传感器 数据 可 直接 用 于 控制 ， 但 也 用 于 估计 机 器 
人 和 (或 ) 环境 的 状态 。 状 态 的 定义 及 适合 的 估计 
方法 与 当前 应 用 所 采用 的 表示 方法 紧密 相关 。 

有 很 多 种 可 能 的 环境 表示 方法 ， 包 括 最 典型 的 几 
何 元 素 ， 例 如 点 、 曲 线 、 表 面 和 容积 。 机 器 人 的 一 个 
基本 概念 是 刚体 的 姿势 。 机 器 人 或 者 实体 在 环境 中 的 
姿势 由 相对 于 参考 框架 的 位 置 与 方向 来 表征 。 

一 般 来 说 ， 用 参数 对 (R, T) 来 代表 姿势 。 这 
E, RR 是 物体 的 方向 ,用 相对 于 参考 框架 的 旋转 矩阵 
来 表示 。 类 似 地 ，7 表示 物体 相对 于 参考 框架 的 平 
移 。 参 考 框架 之 间 的 变换 有 多 种 潜在 的 表达 方式 ， 在 
运动 学 章节 (第 1 章 ) 和 参考 文献 [4.43] 中 有 详 
细 表 述 。 

传感器 数据 在 本 地 传感器 参考 框架 中 采集 ， 例 
如 ， 声 纳 转换 器 、 雷 达 扫描 仪 和 立体 图 像 系统 都 用 来 
测量 环境 中 的 表面 相对 于 传感器 自身 框架 的 距离 。 但 
是 ， 如 果 目 标 是 将 这 类 信息 组 合成 常见 的 环境 模型 ， 
数据 必须 转换 成 以 机 器 人 为 中 心 的 参考 框架 ,或 者 也 
可 转换 成 到 一 个 固定 世界 (惯性 ) 参考 框架 中 。 特 
别 地 ， 世 界 中 心 参考 框架 令 机 器 人 运动 和 通信 可 以 简 
单传 递 给 其 他 机 器 人 和 (或 ) 用 户 。 

为 方便 讨论 ， 绝 大 多 数 集成 传感器 数据 的 表示 方 
法 可 以 分 为 四 个 通用 模型 类 别 : OD 原始 传感器 数据 模 
型 ，@@ 基 于 网 格 的 模型 ; @@ 基 于 特征 的 模型 ; OFS 
或 者 图 形 模型 。 

很 自然 地 ， 也 可 以 组 合 这 四 个 类 别 的 元 素来 获得 
混合 环境 模型 。 


4.4.1 原始 传 感 二 表征 


对 于 简单 反馈 控制 “” ， 常 见 做 法 是 将 原始 传 感 
器 数据 直接 整合 至 控制 系统 ， 因 为 在 许多 情况 下 ， 控 
制 本 身 并 不 需要 世界 模型 。 例 如 ， 常 常 这 样 应 用 本 体 
感受 传 感 : 基本 的 轨迹 控制 直接 利用 关节 编码 器 的 信 
息 ， 而 力 控制 直接 利用 来 自力 传感器 的 受 力 或 转 矩 信 
BEZE, 

外 感受 传 感 中 原始 传感器 模型 没有 这 样 常用 ,但 
是 有 些 情况 下 还 是 有 用 的 。 例 如 ， 移 动机 器 人 从 密集 
点 数据 构建 地 图 。 这 种 方法 对 激光 测 距 仪 特别 常用 ， 
用 扫描 校准 来 生成 基于 点 的 世界 模型 。 参 考 文献 











(4.45, 46] 证 明了 多 条 激光 距离 扫描 能 够 合成 一 个 
环境 模型 。 用 公式 表达 ， 在 时 间 : 的 一 个 环境 扫描 可 
表示 成 点 集 
P.= 1p, =(pi.0,) | iel…N| (4. 50) 

然后 通过 标准 的 SE (3) 变换 来 校准 两 个 不 同 的 扫描 
P, 和 2P,,1。 常 用 ICP 算 法 “小 来 估计 上 述 变换 : 假设 
TU 为 两 个 点 集 之 间 变 换 的 初始 估计 ， 并且 
lp, -pi | 为 点 集 PPA RAE PL h HA h 
一 点 之 间 的 欧 几 里 德 距离 。 如 果 进 一 步 令 CP 为 确 
定 一 个 点 集中 与 男 外 一 个 扣 集 最 近 的 点 的 满 数 ， 
S @ 为 两 个 点 集 之 间 的 点 对 集合 。 通 过 下 述 算法 
的 迭代 : 

1) 计算 @ = Ul, Í Pis CPUT" (p,, Palto 

2) 估计 TE, HB SEC. HA Zl) LSQ 误差 
最 小 ， 坦 到 误差 收敛 。 
可 以 找到 扫描 校准 的 估计 ， 并 构建 环境 的 合成 模型 。 

模型 易于 构建 并 适合 单一 模 态 传感器 数据 的 集 
成 。 通 常 模型 并 不 包含 不 确定 度 信 息 ， 且 随 着 模型 增 
长 ,复杂 度 OCY, LP) 将 变 成 一 个 问题 。 


基于 网 格 的 表示 方法 


在 一 个 基于 网 格 的 表示 方法 中 ， 环 境 被 细 分 为 
许多 单元 。 单 元 能 容纳 环境 特征 ， 例 如 温度 、 障 碍 
物 、 力 分 布 等 。 网 格 的 维度 通常 为 二 或 者 三 ， 随 有 具 
体 的 应 用 而 定 。 网 格 可 以 是 均匀 细 分 或 者 是 利用 四 
叉 树 或 八 叉 树 的 树 状 划 分 “”。 基 于 树 的 方法 特别 
适合 处 理 非 均 名 及 大 尺度 数据 集 。 在 一 个 网 格 模型 
中 ， 每 一 单元 含有 一 个 沿 参数 集 分 布 的 概率 。 例 如 ， 
用 网 格 模 型 来 表示 物理 环境 时 ， 单 元 规定 为 占用 或 
者 空闲 ， 并 有 概率 已 《表示 占用 率 ) 。 一 开始 无 已 知 
言 息 ， 故 网 格 被 初始 化 为 P (占用 ) = 0.5 来 表示 其 
状态 未 知 。 进 一 步 假定 传感器 模型 P(R]| S) 可 用 ， 
即 ， 对 给 定 的 传感器 和 位 置 检测 到 物体 的 概率 。 
ct Wo wwe”, AEM RK E a 
模型 : 





4. 4. 2 





P(R|S, = 0)p;i 

ps(t+1) = BRS =0)p + P(RIS, =F) (1 pst) 
此 处 ， 每 当 获 取 到 新 数据 ， 就 通过 网 格 模型 计 
算 Pio 

基于 网 格 的 模型 已 经 广泛 用 于 移动 机 器 人 “和 
和 广泛 应 用 图 像 容积 的 医疗 图 像 领 域 “”。 容 积 模型 
可 以 相对 很 大 ， 例如， 解析 度 为 毫米 级 的 人 脑 网 格 模 
型 需要 4GB 的 存储 空间 ， 因 此 需要 相当 多 的 计算 资 
源 来 进行 维护 。 
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4.4.3 离散 特征 表示 


原始 传感器 表示 和 基于 网 格 的 模型 都 包含 传感器 
数据 的 最 小 抽象 。 在 许多 情况 下 ， 我 们 感 兴趣 的 是 从 
传感器 数据 提取 特征 以 降低 存储 的 需求 ， 只 保留 平台 
运动 过 程 中 始终 不 变 的 数据 或 外 部 对 象 。 特 征 的 范围 
包括 大 部 分 标准 几何 实体 例如 点 (p), 线 (1) , H 
(N, p), HER (p(s)) 和 更 通用 的 表面 。 为 估计 外 
部 环境 的 属性 ， 混 合 模型 是 有 必要 的 ， 即 把 特征 集合 
整合 到 一 个 统一 的 状态 模型 中 。 

通常 在 三 维 空间 只 (3) 表征 一 个 点 。 传 感 器 具 
有 相应 的 于 扰 ， 因 此 ， 在 大 多 数 情况 下 ， 点 具有 相 
应 的 不 确定 度 ， 一 般 用 均值 为 上 ， 标 准 偏差 为 er 的 
高 斯 变量 来 模拟 。 用 一 阶 和 二 阶 矩 可 求 得 统计 量 的 
估计 。 

表征 直线 特征 更 加 困难 。 数 学 上 的 直线 可 以 用 向 
量 对 (p, t) 来 表示 ， 即 直线 上 的 一 点 和 切 向 量 。 在 
许多 实际 的 应 用 中 ， 直 线 为 有 限 长 度 ， 故 有 必要 对 直 
线 的 长 度 进行 编码 ， 这 可 以 用 端点 、 起 点 、 切 线 和 长 
度 来 实现 。 在 某 些 情况 下 ， 直 线 模 型 的 元 余 表 征 更 加 
有 利于 简化 更 新 和 匹配 。 端 点 不 确定 度 与 其 他 直线 参 
数 之 间 的 关系 可 以 用 分 析 方 法 加 以 推导 ， 如 文献 
[4.51] 所 述 。 直 线 参 数 的 估计 通常 基于 之 前 描述 的 
RANSAC 方法 ， 通 过 霍 夫 变 换 “ RKM, BREM 
是 另外 一 种 基于 表决 的 方法 。 

对 于 更 复杂 的 特征 模型 ， 例 如 曲线 或 者 表面 ， 
有 必要 利用 有 助 于 鲁 棒 特征 分 离 和 相关 不 确定 度 估 
计 的 检测 方法 。 文 献 [4.36] 中 有 该 类 方法 的 完整 
描述 。 


4.4.4 ”符号 /基于 图 的 模型 


第 4.4.1 ~4.4.3 节 所 描述 的 所 有 代表 方法 本 质 
上 都 是 参数 型 ， 相 关 的 语义 有 限 。 用 于 识别 结构 ， 空 
i], 位置 和 物体 的 方法 近来 有 很 大 进展 ， 这 要 特别 归 
功 于 统计 学 习 理 论 的 进展 “"” 。 因 此 ， 如 今 有 许多 
不 同方 法 用 于 识别 传感器 数据 中 的 复杂 结构 ， 例 如 标 
志 物 、 路 表面 、 体 结构 等 。 如 有 识别 的 构造 可 用 ， 则 
可 利用 前 面 讨论 过 的 图 形 模 型 来 表征 环境 。 一般， 一 
张 图 由 一 组 节点 入 和 一 组 连接 节点 的 边 E 所 组 成 。 
节点 和 边 都 可 拥有 相关 的 属性 ， 例 如 标签 和 距离 。 图 
结构 的 一 个 例子 是 环境 拓扑 图 ， 如 图 4. 16 所 示 。 图 
的 表征 也 可 以 是 环境 的 语义 模型 (物体 和 地 点 ) 或 
者 是 待 组 装 的 物体 成 分 的 表征 。 





图 4.16 空间 环境 的 拓扑 图 


关于 模型 更 新 ， 基 于 语义 /图 的 表征 可 以 利用 由 
Pearl 所 表述 的 贝 叶 斯 推理 方面 的 最 新 进展 “”， 并 
可 在 文献 [4.54] 中 找到 应 用 实例 。 


结论 与 扩展 阅读 


传 感 和 估计 仍 是 机 器 人 研究 的 挑战 性 和 活跃 领 
域 。 传 感 的 几 个 领域 ， 例 如 计算 机 视觉 和 医学 图 像 本 
身 是 很 大 而 多 样 的 研究 领域 。 同 时 ， 估 计 中 新 的 基础 
及 应 用 技术 仍 将 被 持续 开发 。 实 际 上 ， 可 以 说 感觉 仍 
将 是 机 器 人 研究 的 最 具 挑 战 性 领域 之 一 。 

基于 这 样 的 背景 ， 单 个 章节 不 可 能 涵盖 基于 传 感 
器 的 机 器 人 发 展 中 的 所 有 有 用 材料 。 但 是 ， 本 章 中 所 
论述 的 方法 代表 机 器 人 中 的 最 常用 技术 。 特 别 是 ， 线 
性 技术 例如 级 尔 曼 滤 波 仍 然 是 感觉 机 器 人 的 主干 。 本 
手册 的 第 3 篇 更 深入 地 涵盖 了 传 感 与 估计 中 的 数 个 关 
键 主题 。 

如 果 读 者 希望 了 解 更 多 ， 在 现代 传感器 手册 中 
可 以 找到 有 关 传 感 器 设计 、 物 理学 和 使 用 不 同 传 感 
器 的 一 般 讨 论 “”。 在 参考 文献 [4.55] 中 可 找到 
关于 移动 机 器 人 传感器 的 讨论 ， 虽 然 自 该 书 于 十 余 
年 前 出 版 后 取得 了 重大 进展 。 参 考 文献 [4.56] 和 
[4.57] 中 详细 描述 了 利用 计算 机 视觉 进 行 传 感 与 
估计 。 

许多 的 优秀 教科 书 都 涵盖 了 基本 的 估计 理论 。 参 
考 文献 [4.18] 和 [4.58] 中 深入 涵盖 了 检测 和 线 
性 估计 理论 的 大 部 分 内 容 。 参 考 文献 [410], 
[4.11] 及 其 最 新 版 本 [4.36] 中 涵盖 了 通用 统计 学 
估计 。 参 考 文献 [4.19, 35] 详细 描述 了 和 鲁 棒 方法 。 
参考 文献 [4.31] 也 深入 涵盖 了 移动 机 器 人 的 估计 
方法 。 
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机 器 人 的 一 个 根本 任务 ， 就 是 要 实现 从 开始 位 置 
到 目标 位 置 的 无 磁 撞 运动 ， 这 需要 通过 收集 障碍 物 的 
静态 位 置 ， 并 对 复杂 组 合体 进行 规划 来 实现 。 虽 然 问 
题 相对 简单 ， 但 其 几何 路 径 规划 还 是 难以 计算 1。 
另外 在 实际 机 器 人 中 ， 由 于 机 械 和 传 感 方面 的 一 些 限 
4, 需要 通过 公式 的 扩展 对 这 些 间 题 加 以 考虑 ， 如 不 
确定 性 、 反 馈 和 微分 约束 ， 后 者 还 涉及 更 为 复杂 的 自 
动 规划 问题 。 现 代 算 法 已 经 在 几何 问题 上 比较 成 功 地 
解决 了 一 些 难点 算 例 ， 并 一 直 在 努力 扩展 其 解决 更 具 
挑战 性 算 例 的 能 力 。 这 些 算 法 的 应 用 范围 已 超出 机 器 
人 学 领域 ， 如 用 于 计算 机 动画 、 虑 拟 样机 和 计算 生物 
学 等 。 对 于 现代 运动 规划 技术 及 其 应 用 ， 现 有 的 许多 
研究 报告 5* 和 专业 书籍 ”… ， 已 经 涵盖 了 这 一 
领域 。 
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5.1 运动 规划 的 概念 


本 节 只 提出 基本 运动 规划 问题 (或 几何 路 径 规 

划 问 题 ) 的 描述 ， 至 于 将 这 些 基 本 公式 扩展 到 更 为 

杂 的 情况 ， 将 在 后 面 章节 加 以 讨论 ， 并 将 贯穿 于 本 
书 之 中 。 


5.1.1 构 型 空间 


FERRARI, SORE LAE A A 和 工作 空间 
W 的 完整 几何 描述 : 工作 空间 Ww =R*, 其 中 N=2 
或 N=3， 为 含有 障碍 物 的 静态 外 部 环境 。 我 们 的 月 
的 是 为 机 器 人 内 找 出 一 条 无 碰撞 路 径 ， 使 其 从 初始 
位 姿 《〈 位 置 和 姿态 ) 移动 到 目标 位 姿 。 
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为 实现 这 一 目标 ， 必 须 提供 机 器 人 几何 位 置 上 的 
每 一 个 点 ( 即 构 型 g) 的 完整 说 明 。 这 里 引入 构 型 空 
间 ， 也 称 C 空 间 〈g see) ， 它 是 所 有 可 能 构 型 所 组 成 
的 空间 。C 空间 表示 的 运动 学 变换 集 ， 能 用 于 第 1 章 
(运动 学 ) 中 表述 的 、 所 有 给 出 的 机 器 人 运动 学 变 
换 。 在 运动 规划 研究 中 ， 人 们 早 就 认识 到 和 C 空间 是 

一 个 很 有 用 的 途径 ， 它 能 将 各 种 规划 问题 抽象 为 统一 
的 方式 。 这 种 抽象 的 优点 在 于 ， 具 有 复杂 几何 形状 的 
ILAA, AIRERA C 空间 的 一 个 点 上 ， 机 器 人 系 
统 的 自由 度数 是 C 空间 的 维 数 , 或 者 是 指定 构 型 所 
需 参数 的 最 小 个 数 。 

设 闭 集 @C W 表 示 (工作 空间 的 ) 障碍 区 域 ， 通 
常用 多 面体 、 三 维 (3-D) 三 角形 或 分 段 代 数 曲 面 的 
ERER, WA Alq) C W， 表 示 机 器 人 在 构 型 
qe C 上 所 占据 点 的 集合 ， 它 通常 采用 与 8 相同 的 图 
元 来 模拟 。C 空间 障碍 区 域 Cu 定 义 为 

Cas = ge CIAC) N OZO) (5.1) 

HFOMAG) 均 为 W 上 的 闭 集 ， 因 此 障碍 区 
域 也 是 CI 上 的 一 个 闭 集 。 无 (避免 ) 碰撞 的 构 型 集合 
Cree = C\ Cw, ， 称 为 自由 空间 。 

C 空间 简单 举例 如 下 。 

1) 平面 刚体 的 平移 。 机 器 人 构 型 可 用 一 个 参考 
A (a, y) 来 表示 ， 这 个 点 位 于 相对 于 某 固 定 坐 标 
的 平面 刚体 上 ， 因 此 这 里 C 空间 等 效 于 RR*。 图 5.1 
给 出 了 一 个 三 角形 机 器 人 和 一 个 多 边 形 障碍 物 所 构成 
的 C 空间 的 例子 。 其 中 C 空间 内 的 障碍 区 域 可 通过 
记录 机 器 人 在 工作 空间 障碍 物 周 围 滑动 的 轨迹 ， 然 后 
找 出 所 有 qe C 上 的 约束 来 实现 。 对 机 器 人 的 运动 规 
划 ， 就 等 效 为 对 C 空间 上 一 个 点 的 运动 规划 。 


机 器 人 PO) 





构 型 空间 障碍 
b) 


a) 


图 5.1 平面 上 的 机 器 人 平移 
a) 三 角形 机 器 人 在 带 有 单个 矩形 障碍 物 的 
工作 空间 上 移动 b) C 空间 障碍 


2) 平面 臂 。 图 5. 2 给 出 了 一 个 两 关节 平面 臂 的 例 
子 ， 两 个 连 杆 的 底部 钉 住 ， 因 而 只 能 没 关 节 做 无 限 位 
的 转动 。 对 于 这 个 臂 ， 用 参数 9, 和 名 来 表示 构 型 ， 每 
个 关节 角 8 对 应 于 单位 圆 S 的 一 点 ， 因 而 C 空间 为 
S' xS =F, HR HUR 5.2 所 示 。 对 于 无 关 


节 限 制 连 杆 数 更 多 的 情况 ，C 空间 可 类 似 的 定义 为 : 





b) 


图 5.2 二 维 圆 面 环 
a) WAXES (其 中 连 杆 钉 住 

且 无 关节 限制 ) b) C 空间 
C=S!xS!x-.…xS (3. 2) 
如 果 关 节 有 限 位 ， 通 常 可 用 有 限 区 间 R 来 替代 相 
应 的 S!; 如 果 平 面 辟 的 底部 没有 知 住 ， 是 可 移动 的 ， 

则 需要 考虑 在 臂 构 型 上 加 上 平移 参数 : 
C=R’?xS' xS! x- xS (5.3) 
在 后 面 的 5.6.1 节 ， 我 们 将 讨论 构 型 空 全 的 拓扑 


属性 ， 并 提供 了 另外 一 些 C 空间 的 例子 。 
5.1.2 几何 路 径 规 划 问 题 


基本 运动 规划 问题 ， 又 称 为 钢琴 移动 问题 5 ， 
其 定义 如 下 。 

CA: 

1) 工作 空间 W,， XB WHR? REWER’, 

2) 障碍 区 域 OC W, 

3) 定义 于 WW 的 机 器 人 ， 它 为 一 个 刚体 为 ， 或 者 
m 个 构件 ( 连 杆 ) 的 集合 : AL, An, ++, Amo 

A) 构 型 空间 @ (AFR Cas A Cree ) o 

5) 初始 构 型 gi = Cres 

6) 目标 构 型 qo € Criee。 初 始 构 型 和 目标 构 型 常 
称 作 查 询 (9 ，gc ) 。 

问题 : 计算 一 条 (连续 ) 路 径 z: [0， 
使 得 5(0) =g, AT(1) =g6。 


5.1.3 运动 规划 的 复杂 度 


运动 规划 中 最 主要 的 复杂 因素 在 于 ， 直 接 计算 
Cu 和 Cre RITE, IE C 空间 的 维 数 往往 很 高 。Reif 
早先 研究 了 钢琴 移动 问题 ， 根 据 计 算 的 复杂 度 分 类 ， 
这 一 问题 被 证 明 为 PSPACE-hard 7 。 对 于 固定 维 数 
问题 ， 一 些 多 项 式 - 时 间 算 法 指出 ， 问 题 的 难度 与 维 
BE RAE BO ED'S Canny 提出 了 在 C 空间 
维度 上 的 单一 指数 -时 间 算 法 ， 这 一 问题 被 证 明 为 
PSPACE- complete!* 2] 。 虽 然 该 算法 并 不 实用 ， 但 在 
基本 运动 规划 问题 研究 中 ， 可 作为 一 般 问 题 的 难度 


] ] — Cree + 
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土 限 。 它 应 用 计算 代数 几何 建 模 技术 ， 对 C 空间 进 
行 建 模 ， 来 构建 路 线 图 ， 即 一 个 具有 Cre FE FE PE W 
一 维 (1-D) 子 空 间 。 关 于 这 一 技术 的 更 多 详情 ， 
见 5.6.3 节 。 

问题 的 复杂 度 ， 推 动 了 路 径 规划 问题 的 研究 。 其 
中 一 个 方向 是 采用 多 项 式 - 时 间 算 法 ， 研 究 普遍 问题 
的 某 些 子 类 ”1。 但 即使 是 这 样 一 些 简 单 的 运动 规划 
特例 ， 仍 然 被 看 做 是 一 种 挑战 ， 例 如 R” 中， 平行 于 
轴 的 矩形 做 有 限 次 平 稀 ， 这 种 简单 情况 ， 其 复杂 度 也 
是 PSPACE-hard。 对 某 些 运 动 规划 的 扩展 就 更 难 了 ， 
例如 ，3 维 多 面 体 环境 中 ， 不 确定 性 下 的 某 种 规划 形 
式 为 NEXPTIME-hard55  。NRXPTIME 中 最 大 的 难题 
在 于 需要 双 倍 指数 的 时 间 来 进行 求解 。 

男 外 一 个 方 铝 是 替代 运动 模式 的 发 展 ， 和 替代 模式 
的 假设 建立 在 实际 应 用 的 基础 上 。 组 合 方法 能 通过 特 
定 的 二 维和 三 维 问题 ， 来 有 效 构建 一 维 线路 图 ; 势 场 
法 通过 定义 矢量 场 ， 能 够 跟随 机 器 人 朝日 标的 运动 。 
然而 ， 这 两 种 方法 都 不 能 成 规模 地 用 于 普遍 情况 ， 这 
些 将 在 5.3 节 讲 述 。 基 于 抽样 的 规划 是 另外 一 种 替代 
模式 ， 它 作为 一 种 常用 方法 ， 已 被 证 明 能 成 功用 于 解 
决 实践 中 的 许多 难题 。 此 方法 虽然 避免 了 [C 空间 的 
精确 几何 模拟 问题 ， 但 却 不 能 保证 算法 的 完备 性 。 因 
为 完备 、 精 确 的 算法 能 够 检测 出 无 路 径 寻 的 情况 ， 而 
基于 抽样 的 规划 方法 ， 只 能 提供 较 低 水 平 的 完备 性 保 
证 。 这 种 模式 将 在 下 面 一 节 讲 述 。 


5.2 基于 抽样 的 规划 


本 节 首 先 讲 述 基 于 抽样 的 规划 ， 因 为 对 于 很 多 通 
常 类 型 的 问题 ， 都 可 以 选用 这 种 方法 ， 下 一 节 将 讲述 
其 他 方法 ， 它 们 中 的 一 些 还 早 于 抽样 规划 架构 。 基 于 
抽样 规划 的 核心 思想 ， 是 利用 碰撞 检测 算法 的 进步 ， 
来 计算 单个 构 型 是 否 为 无 磁 撞 。 给 出 简单 图 元 后 ， 规 
划 紫 通过 对 不 同 构 型 进行 采样 并 构建 数据 库 ， 用 于 存 
储 一 维 C 空间 曲线 ， 它 代表 无 碰撞 路 径 。 在 这 种 方 
法 中 ， 基 于 抽样 的 规划 器 不 直接 接近 C 空间 的 障碍 ， 
而 是 通过 碰撞 探测 右 和 构建 数据 结构 来 进行 。 使 用 这 
种 抽象 层次 ， 对 于 特定 的 机 器 人 及 其 应 用 ， 通 过 合理 
布置 取舍 碰撞 探测 器 ， 规 划 器 能 广泛 适用 于 多 种 问题 。 

对 于 基于 抽样 的 规划 豆 而 言 ， 其 标准 是 提供 一 个 
完备 性 较 弱 ， 但 仍 值 得 关注 的 规划 形式 : 如 果 解 的 路 
径 存 在 ， 那 么 规划 需 就 会 最 终 找到 它 。 放 弃 更 强 的 完 
备 性 形式 ， 这 也 要 求 在 有 限时 间 内 能 报告 失效 情况 ， 
这 项 技术 能 解决 三 自由 度 以 上 完备 性 方法 所 不 能 解决 
的 实际 问题 。 完 备 性 弱 形 式 的 更 详细 介绍 ， 安 排 在 


5. 6.2 节 。 

如 何 进 行 抽样 构 型 和 构建 何 种 数据 结构 ， 不 同 的 
规划 有 不 同 的 方法 。5. 6. 2 节 将 对 抽样 问题 进行 更 深 
和 人 的 探讨 。 对 于 基于 抽样 的 规划 器 ， 典 型 的 分 为 两 
类 : 多 查询 方法 和 单 查询 方法 。 

在 第 一 类 中 ， 首 先 构建 路 线 图 ， 规 划 器 预先 计算 
一 次 无 向 图 G， 以 便 映射 出 Cte 空间 的 连接 属性 。 完 
成 这 一 步 后 ， 相 同 环境 下 的 多 查询 回答 只 需要 运用 已 
构建 的 路 线 图 即 可 。 这 类 规划 器 在 5. 2. 1 节 讲 述 。 

第 二 类 规划 方法 ， 通 过 联机 给 出 规划 查询 的 树 数 
据 结 构 ， 规 划 器 集中 搜索 C 空间 的 一 部 分 ， 以 尽 可 
能 快 地 解答 具体 的 查询 问题 。 这 类 规划 将 在 5.2.2 节 
讲述 。 

两 类 方法 对 于 碰撞 图 元 检查 的 用 法 是 相似 的 ， 碰 
樟 探 测 占 的 目的 就 是 要 报告 给 定 目标 几何 构 型 和 变换 
闻 的 所 有 几何 接触 。 规 划 器 软件 包 的 实用 性 在 
于 ， 能 在 几 分 之 一 秒 内 完成 碰撞 查询 ， 这 对 于 基于 规 
划 抽 样 算 法 的 发 展 至 关 重 要 。 现 代 规 划 采 用 黑箱 
(black box) 作为 碰撞 探测 器 ， 最 初 规划 器 提供 所 有 
涉及 目标 的 几何 条 件 ， 并 指出 其 中 哪些 是 可 移动 的 ; 
然后 为 验证 机 器 人 的 构 型 ， 向 相关 的 机 器 人 提供 运动 
变换 ， 碰 撞 探测 器 回应 目标 间 是 否 有 碰撞 。 许 多 软件 
包 对 几何 模型 采用 分 级 表示 ， 以 避免 计算 中 全 是 两 个 
两 个 地 相互 作用 ， 并 采用 二 分 搜索 法 来 评估 碰撞 。 除 
了 构 型 外 ， 规 划 器 还 必须 验证 全 部 路 径 。 一 些 磁 撞 探 
测 器 返回 碰撞 距离 信息 ， 这 可 以 有 效用 于 推断 C 空 
间 中 的 全 部 邻 域 。 这 种 提取 信息 的 方法 代价 很 高 ， 但 
如 果 采 用 小 步 长 增 量 或 二 分 搜索 方式 逐 点 验证 路 径 ， 
往往 代价 更 高 。 一 些 碰撞 探测 器 设计 为 步 进 式 的 ， 以 
便 它 们 能 重新 使 用 以 前 的 查询 信息 ， 因 而 速度 
Be: 16] 5 


综合 查询 规划 : 映射 Cree 的 连接 性 


规划 融 旨 在 解答 某 一 静态 环境 中 的 多 重 查询 时 ， 
在 预 处 理 阶 段 采用 将 Cr 的 连接 性 映射 到 路 线 图 中 。 
该 路 线 具 有 图 6 的 形式 ， 并 带 有 构 型 顶点 和 路 径 边 
线 。 如 果 满足 下 列 性 质 ， 则 1 维 曲线 的 并 集 为 路 线 
图 G, 

1) 可 达 性 。 由 任意 ge E Cree， 可 简单 有 效 地 计 
算 一 条 路 径 z: [0,1] 一 Crwe， 以 使 (0) =q, B 
T(1) =s。 其 中 s ASG) 中 的 任意 一 点 ,SS(G) ÆG 
的 行 迹 ， 为 边线 和 顶点 能 到 达 的 所 有 构 型 合集 。 这 意 
味 着 总 是 可 以 将 规划 查询 对 8 和 gc 分 别 与 SCC) 上 
的 某 对 S, A Sc 连接 起 来 。 

2) 连接 性 保护 。 第 2 个 条 件 要 求 : 如 果 存 在 路 


5.2.1 
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FET: [0，1j 一 Cr 使 得 5(0) =q, HT) =q,, W 
ETER T: [0, 1 一 3S(C)， 使 得 z(0) =q, 
T'(1) =qc， 这 样 就 可 以 避免 由 于 C 未 能 捕捉 到 Cree 
的 连接 性 ， 而 出 现 解 丢失 的 情况 。 

概率 路 线 图 方法 ( PRM) 在 计算 概率 方面 ， 
采用 的 是 近似 路 线 图 的 方式 。RPM 的 预 处 理 阶 段 ， 
通常 可 扩展 为 基于 抽样 的 路 线 图 ， 步 又 如 下 : 

1) 初始 化 。 设 G6(V,，E) 表示 一 个 无 向 图 ， 初 
始 状态 为 空 。C 的 顶点 将 对 应 于 无 碰撞 构 型 ， 连 接 顶 
点 的 边线 对 应 于 无 碰撞 路 径 。 

2) 构 型 采样 。 将 从 Ceee 中 抽样 得 到 的 构 型 (i) , 
加 入 顶点 集 了 中 。 这 al(，) 表示 无 限 、 密 集 的 样本 
序列 ，a(i) 为 这 个 序列 中 的 第 i 个 点 。 

3) 邻 域 计 算 。 通 常 在 C 空间 中 定义 一 个 度量 ， 
p:Cx C 一 R 。 存 在 于 V 中 的 顶点 49， 如 果 依 照度 量 p 
为 小 距离 ， 则 可 选 为 ali) 邻 域 的 一 部 分 。 

4) 边线 考虑 。 对 于 不 属于 6 上 相同 连接 分 量 
ali) 的 那些 顶点 9， 该 算法 通过 边线 将 其 相连 。 

5) 局 部 规划 方法 。 给 定 ali) 和 ge Cie, KA 
模块 来 构建 路 径 T,: [0，1j] 一 Gre， 使 得 F(0) = 
a(i), Tl) =q. 采用 碰撞 检测 ，T, 必 须 通 过 检查 以 
确保 不 产生 碰撞 。 

6) 边线 插入 。 将 志 插 人 五 ， 作 为 由 a(i) We 
的 边线 。 

7) 终止 。 通 常 当 预 定义 的 无 碰撞 顶点 数 NN 已 加 
人 到 路 线 图 中 时 ， 算 法 停止 。 

算法 在 本 质 是 增 量 形式 的 ， 计 算 可 从 一 个 已 存在 
的 图 上 重复 开始 。 通 用 的 基于 抽样 的 路 线 图 ， 总 结 在 
算法 5. 1 中 。 


算法 5.1 
基于 抽样 的 路 线 图 
N: 路 线 图 中 包含 的 节点 数 
G. init( ) ; icO; 
while i < N do 
if a(i) € Cre then 
G. add_vertex(a(i)) ; i—i +1 
for g e NEIGHBORHOOD (ai), G)do 
if CONNECT(a(i) , g) then 
G. add_edge( a(i) ,q) ; 
endif 
end for 
endif 
end while 


图 5. 3 为 算法 行为 的 图 形 描 述 。 为 求解 一 个 
查询 ,将 gq,/ 和 4 连接 到 路 线 图 ， 并 执行 图 搜索 
任务 。 





5.3 通过 逐次 将 单个 新 样本 与 邻近 项 点 相连 ， 
递增 构建 基于 抽样 的 路 线 图 


对 于 原始 PRM"! ， 构 型 a(i) 采用 随机 抽样 产 
生 。 对 于 gg Mali) 之 间 的 连接 步 ， 算 法 中 采用 C 空 
间 上 的 直线 路 径 。 在 某 些 情况 下 ， 如果 g 和 a(i) 在 
相同 连接 分 量 上 ， 则 不 用 连接 。 许 多 后 续 工 作 可 用 于 
在 更 少 采样 点 的 情况 下 提高 路 线 图 的 质量 : 在 Ct 的 
边界 点 (或 靠近 ) 进行 集中 采样 的 方法 见 参考 文献 
(5.20, 21]; 远离 边界 点 处 的 移动 采样 方法 见 参 考 
文献 (5.22, 23]; 包含 网 络 的 确定 性 抽样 技术 见 参 
考 文献 [5.24]; 基于 交互 可 视 性 的 顶点 剪 枝 方法 ， 
可 大 为 减少 路 线 图 的 顶点 数 ””] ， 基 于 抽样 路 线 图 的 
理论 分 析 见 参考 文献 [5.24，26，27] ， 并 在 5.6.2 
节 作 了 简要 论述 ; 文献 [5.28] 对 基于 抽样 的 路 线 
图 不 同形 式 进行 了 实验 对 比 ; 对 于 路 线 图 方法 中 识别 
狭窄 通道 的 难点 问题 ， 有 人 建议 采用 网 桥 测试 来 进行 
Be”). 对 于 基于 概率 路 径 图 (PRM) 的 其 他 方 
法 见 参 考 文献 [5.30-34] 。 本 主题 的 更 多 讨论 可 参 
阅 参考 文献 [5.5, 7]。 


5.2.2 单一 查询 规划 : 增 量 搜索 


单一 查询 规划 方法 集中 于 一 个 单一 初始 目标 构 型 
对 ， 通 过 延伸 树 型 数据 结构 ， 探 查 连续 的 C 空间。 
数据 结构 在 这 些 已 知 构 型 中 初始 化 ， 并 最 终 与 它们 相 
连 。 大 多 数 单一 查询 方法 遵循 以 下 步骤 : 

1) 初始 化 : RGV, E) 表示 一 个 无 向 搜索 图 ， 
顶点 集 了 包含 Cr 中 的 一 个 〈 和 常 为 9 ) 或 多 个 构 型 的 
顶点 ， 且 边线 集 为 空 。G 的 顶点 为 无 碰撞 构 型 ， 且 
连接 顶点 的 各 边线 为 无 碰撞 路 径 。 

2) 顶点 选择 方法 : 选择 一 个 用 于 扩展 的 顶点 
Four E Vo 
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3) 局 部 规划 方法 : 对 某 些 qi, E Cree, ARNT 
一 个 存在 于 了 中 的 顶点 ， 但 在 不 同 的 树 或 样本 构 型 
E, 构建 一 条 路 径 t,: [0,1] 一 Cre, 使 得 5T(0) = 
Goer 71) =Qrwo 采用 碰撞 检测 ， 则 元 必 须 检查 以 确 
保 不 会 引起 碰撞 。 如 果 这 一 步 未 能 产生 一 个 无 碰撞 路 
径 段 ， 则 转向 第 2 步 。 

4) 在 图 中 插入 边线 ; 将 Tt, 插 入 EE 中 ， 作 为 一 条 
从 gw 到 gq 的 边线 。 如 果 g,,, 还 不 在 V 中 ， 则 它 也 需 
要 插入 。 

5) 求解 检查 : 确定 6 的 编码 是 否 为 求解 路 径 。 

6) 返回 第 2 步 : 除非 满足 终止 条 件 ， 算 法 将 返 
回 第 2 APRS IE, KEKER ERDO ARE, 
二 是 满足 设 定 的 终止 条 件 ， 这 种 情况 下 报告 算法 失败 。 

在 执行 过 程 中 ，G 可 以 组 织 一 个 或 多 个 树 ， 这 会 
导致 : 

1) 单 向 方法 。 它 只 包含 单 棵 树 , 通常 根 在 
gq Able! 

2) 双向 方法 。 它 包含 两 棵 树 ， 通 常 根 在 gf 和 
9 处 5251 。 

3) 多 向 方法 。 它 可 有 两 棵 以 上 的 树 **””1。 采 
用 多 棵 树 的 动机 在 于 ， 在 通过 狭 罕 通路 寻找 出 口 时 ， 
单一 树 可 能 存在 陷阱 而 在 相反 方向 返回 时 ， 可 能 会 
更 容易 些 。 

随 着 所 考虑 树 数 的 增多 ， 确 定 树 之 间 如 何 进 行 连 
接 ， 将 变 得 更 为 复杂 。 

1. 快速 搜索 密集 树 

此 类 技术 的 主要 想法 是 ， 算 法 应 逐渐 加 强 对 C 
空间 属性 的 探测 力度 。 实 现 这 一 目标 的 算法 ， 称 为 快 
速 搜索 随机 树 (RRT)“” ， 它 可 广泛 用 于 快速 搜索 
密集 树 (RDT) ， 进 行 任 意 密 度 、 确 定性 或 随机 抽 
样 生 ”。 其 基本 思想 是 ， 通 过 树 上 选择 的 一 个 扩展 
点 ， 在 搜索 过 程 中 引 人 Voronoi 偏 置 。 采 用 随机 样本 ， 
顶点 选择 的 概率 与 Voronoi 区 域 的 体积 成 正比 。 其 树 
结构 概述 如 下 : 





算法 5.2 
快速 搜索 密集 树 
k: 算法 的 搜索 步 


G. init( gq,); 

for i=1 to k do 
G. add_vertex(a(i) ) ; 
q,«-NEAREST(S(G), a(i)); 
G. add_edge(g,, a(i)); 

end for 
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树 从 a IIR, BRIER, MA—t+wAaA 
顶点 。 

到 目前 为 止 ， 还 没有 说 明 如 何 到 达 ¢ 的 问题 。 
采用 RDT 的 规划 算法 有 好 几 种 : 一 种 方法 是 偏 置 
ali), Wi gc 能 频繁 选择 (或许 每 50 次 迭代 就 要 选 
择 一 次 ); 另外 更 有 效 的 方法 是 通过 培育 两 棵 树 ， 开 
发 双向 搜索 算法 ， 通 过 彼此 的 9 和 gc 进行 搜索 ， 这 
大 约 有 一 半 时 间 花 费 在 用 常规 方式 扩展 每 棵 树 ， 而 另 
一 半 时 间 则 花费 在 对 树 的 连接 上 。 连 接 树 的 最 简单 方 
式 是 ， 让 一 棵 树 的 最 新 项 点 在 扩展 另 一 棵 树 时 替代 
a(i)。 其 技巧 是 采用 基本 扩展 算法 ,将 一 个 RDT 连 
接 到 另外 一 个 上 ”1。RDT 方法 经 过 不 断 扩 展 ， 现 
已 应 用 到 多 个 方面 上 7” ， 更 详细 的 描述 见 参考 
文献 [5.5, 7]。 

2. 其 他 算法 

参考 文献 [5.43-45 ] 中 提出 了 基于 扩展 空间 
的 规划 方法 。 在 这 种 情况 下 ， 由 于 在 顶点 周围 邻 域 
内 的 点 很 少 ， 算 法 通过 选择 扩展 顶点 进行 强制 搜索 。 
在 参考 文献 [5.46] 中 ,通过 自 调节 随机 行走 以 获 
取 额 外 性 能 ， 其 实质 是 将 所 有 努力 集中 用 于 搜索 。 
其 他 成 功 的 树 算法 ,包括 路 径 定向 细 分 树 算法 
及 其 一 些 变 体 “%” 。 在 这 些 文献 中 ， 有 时 很 难 将 基 
于 树 的 规划 恬 用 于 普通 路 径 规 划 中 ， 因 为 它们 中 的 
许多 (包括 RDT) 需要 设计 为 (或 应 用 于 ) 更 复杂 
的 问题 ( 见 5.4.4 节 )， 其 性 能 对 于 多 种 路 径 规 划 
问题 也 很 出 色 。 


5.3 替代 算法 


对 于 基于 抽样 的 算法 ,替代 方法 包括 基于 势 场 技 
术 方 法 和 组 合 方法 ， 它 也 可 以 生成 路 线 图 ， 例 如 单元 
分 解 。 这 些 算法 能 有 效 解决 狭窄 类 型 问题 ， 在 这 些 情 
况 下 ， 更 优 于 5. 2 节 的 算法 。 多 数组 合算 法 主要 用 在 
理论 研究 方面 ， 而 基于 抽样 算法 的 主要 动机 在 于 解决 
应 用 中 的 性 能 问题 。 当 然 ， 经 过 某 些 抽象 ， 组 合算 法 
也 能 用 于 解决 实际 问题 ， 如 移动 平面 机 器 人 的 目 主 肝 
航 问题 。 


5.3.1 组 合 路 线 图 


有 几 种 算法 适用 于 @ = 展 ， 且 Cu 为 多 边 形 的 情 
况 。 这 些 算法 大 多 昌 不 能 直接 扩展 到 高 维 情况 ， 但 茶 
些 基 本 原理 是 相同 的 。 最 大 间隙 路 线 图 〈 或 称 收缩 
方法 “” ) 构建 路 线 图 时 ， 它 使 路 径 尽 可 能 远离 障 
但 物 ， 其 路 径 通 过 图 5.4 所 示 的 三 种 情况 形成 路 线 


94 第 1 篇 机 器 人 学 基础 


图 ， 它 对 应 于 所 有 与 多 边 形 属性 配对 的 路 线 。 通 过 
生成 所 有 曲线 对 的 可 能 配对 ， 计 算 交 集 并 画 出 路 线 
图 ， 这 样 就 可 以 在 时 间 O(n") 上 构造 出 路 线 图 ( 见 
图 5.5)。 有 些 现 存 的 算法 能 提供 更 好 的 渐 近 运行 时 
间 ” ， 但 它们 实现 起 来 相当 困难 。 其 中 最 著名 的 
算法 运行 在 0(n Ign) WE, XE n ARR h 
op ai [5.51] 。 


We ae 


边线 一 边线 顶点 一 顶点 顶点 一 边线 
图 5. 4 Voronoi 路 线 图 线段 产生 的 三 种 可 能 情况 


(第 三 种 情况 为 二 次 曲线 ) 





图 5.5 如 果 有 障碍 物 ， 磁 撞 检 测算 法 允许 
边线 一 直行 进 到 障碍 物 的 边界 


如 图 5.6 所 示 ， 另 一 种 替代 方法 是 计算 最 短路 径 
路 线 图 |。 这 与 上 一 节 提 出 的 路 线 图 不 同 ， 因 为 考 
虑 路 径 最 佳 〈 短 ) ， 故 允许 路 径 可 触及 至 障碍 物 。 顶 
点 的 内 角 大 于 站 时 ， 路 线 图 的 顶点 是 Cu 的 反射 顶 
点 ， 当 且 仅 当 一 对 顶点 相互 可 见 时 ， 路 径 图 的 边线 存 
在 ， 从 每 个 顶点 中 伸 出 一 条 线 (这 条 线 称 为 双 切 
线 ) ， 该 线 通过 顶点 对 伸 向 Ce。 对 每 个 反射 角 采 用 
径 向 扫描 算法 ， 可 形成 0(m lgn)- 时 间 结 构 算法 。 理 
论 上 可 以 在 时 间 O(n? +m) 上 计算 ,其 中 m 是 路 线 
图 上 边线 的 总 数 “”|。 

图 5.7 显示 的 是 垂直 单元 分 解 方 法 。 其 思想 是 将 
Cre 分 解 为 梯形 或 者 三 角形 单元 ， 每 个 单元 上 的 规划 是 
平凡 的 ， 因 为 其 为 上 三面 。 路 线 图 由 这 样 一 系列 点 构成 ， 
这 些 点 放置 于 每 个 单元 及 单元 间 每 条 边界 的 中 心 处 。 任 
何 一 种 图 搜索 算法 均 可 用 于 快速 找到 无 碰撞 路 径 。 采 用 
平面 扫描 原理 “|! ， 单 元 分 解 可 在 O(n Ign) 时 间 上 
构建 。 设 想 一 条 垂 线 从 *= -到 *= +o PTA, 
当 遇 到 多 面体 的 顶点 时 停 下 来 ， 在 这 种 情况 下 ， 一 个 
单元 的 边界 可 能 必定 位 于 顶点 的 上 面 / 或 下 面 ， 需 要 
在 平衡 搜索 树 上 保持 垂 线段 的 次 序 ， 这 样 才能 在 时 间 





图 5.6 最 短路 径路 线 图 ， 包 括 Ce 上 连续 


反射 项 点 间 的 边 及 其 双 切 线 边 


0(lgn) 内 对 垂直 单元 的 边界 进行 限定 。 整 个 算法 在 
时 间 O(n Ign) 上 运行 ,因为 有 O(n) 个 项 点， 在 这 
些 点 处 能 让 扫描 线 停 下 来 。 也 就 是 说 ， 顶 点 需要 一 开 
始 就 进行 排序 ， 这 需要 时 间 O(n lgn)。 





图 5.7 和 惟 直 单元 分 解 得 到 的 路 线 图 


5.3.2 高 维 路 线 图 


如 果 将 5.3. 1 节 的 方法 直接 扩展 到 更 高 维 数 ， 
可 能 会 更 为 方便 。 尽 管 很 遗憾 不 会 发 生 这 种 情况 ， 
但 还 是 能 够 从 中 扩展 一 些 总 体 思路 。 考 虑 高 维 情 况 
的 单元 分 解 ， 主 要 有 两 条 要 求 : 中 每 个 单元 应 该 足 
够 简单 ， 以 便 单元 上 的 运动 规划 是 平凡 的 ; 凶 单 元 
应 能 很 好 地 组 合 在 一 起 。 对 第 一 条 要 求 ， 充 分 条 件 
是 单元 为 凸 面 ， 也 可 以 允许 为 更 一 般 的 形状 ， 但 在 
任何 情形 下 ， 单 元 都 不 能 含有 孔 。 对 第 二 条 要 求 ， 
充分 条 件 是 单元 能 被 组 合成 一 个 奇异 复 形 ， 这 意味 
着 对 任意 两 个 d 维 单元 (dsn), WRAHA HH 
界 相 交 ( 切 ) ， 那 么 共同 边界 本 身 必须 是 一 个 ( 低 
维 的 ) 完备 单元 。 

在 二 维 多 边 形 C 空间 上 ， 三 角 法 定义 的 好 单元 
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分 解 可 适用 于 运动 规划 。 如 要 找到 一 个 好 三 角形 ， 就 
要 尽量 避 人 锡 薄 三 角形 ， 这 在 计算 几何 中 应 加 以 考 
虑 ”1。 确 定 带 孔 多 面体 障碍 区 域 的 分 解 时 ， 需 要 用 
到 最 小 凸 单 元 数 ， 它 为 NP-hard!) EFE, RAT 
仍 乐 意 采 用 非 最 佳 分 解 方式 。 

在 三 维 C 空间 中 ， 如 果 Cw 是 多 面体 ， 则 可 采用 
平面 递归 扫描 ， 直 接 对 垂直 分 解 方法 进行 扩展 。 例 
如 ， 临 界 同 相 轴 可 能 出 现在 每 个 z 坐标 上 ， 对 其 上 的 
点 进行 二 维 垂 直 分 解 变 化 时 ，x 和 y 坐标 保持 不 变 。 
通过 机 器 人 在 R "中 多 面体 障碍 物 间 的 平移 ， 可 以 得 
到 多 面体 的 例子 ; 然而 最 有 趣 的 问题 是 Cuw 变 为 非 线 
性 情况 。 假 设 C =R’> xS'， 对 应 于 机 器 人 能 够 在 平 
面 上 平 动 和 转动 。 假 设 机 器 人 和 障碍 物 都 是 多 边 形 ， 
对 于 线段 机 器 人 的 情形 ， 人 参考 文献 [5.57] 给 出 的 
O(n?) 算法 能 够 实现 ; 对 于 更 为 一 般 的 模型 及 人 空 
间 情 况 ， 此 方法 已 很 难 用 于 实际 问题 ， 而 主要 用 于 理 
论 研 究 ， 这 将 在 5. 6. 3 节 进 行 介 绍 。 


5.3.3 Bin 


运动 规划 的 不 同方 法 ， 其 灵感 均 来 自 于 不 同 的 避 
障 技 术 “” 。 虽 然 没 有 明确 构建 一 个 路 线 图 ， 而 是 构 
建 一 个 可 微 的 实 值 函 数 7: ROR, RAR RMR, 
由 它 导 出 移动 日 标的 运动 。 如 图 5.8 所 示 ， 势 的 典型 
构造 是 : 它 包含 一 个 吸引 分 量 VU.(q) ， 拉 着 机 器 人 天 
目标 运动 ; 另外 还 包括 一 个 排斥 分 量 已 (9) ， 推 动机 
器 人 远离 障碍 。 势 函数 的 梯度 为 一 个 矢量 V Ul) = 


DU(q)" = sq) a, 2a] ， 其 指向 为 的 


局 部 最 大 增加 方向 。 定 义 0 之后， 从 g ,开始 采用 榜 
度 下 降 法 ， 就 能 计算 出 路 径 : 

1) gq(0) =q,; 1=0 

2) while V U(g(i)) #0 do 

3) gq(i+1)=g(i) +V U(g(i)) 

4) i=i+l 

然而 ， 这 种 梯度 下 降 方法 并 不 保证 能 得 到 问题 
的 解 ， 因 为 梯度 下 降 只 能 到 达 Ula) 的 一 个 局 部 最 
小 值 ， 如 图 5.9 所 示 ， 它 可 能 与 目标 状态 gc 并 不 
相符 o 

既 利 用 势 函 数 ， 又 避免 局 部 最 小 问题 的 规划 方 
法 ， 称 之 为 随机 势 规划 '*”。 其 思想 是 采用 多 重 规 划 
模式 ， 通过 随机 行走 (random walk) 来 组 合 势 函 数 。 
在 第 1 重 模 式 中 ， 梯 度 下 降 法 用 至 达到 一 个 局 部 最 小 
值 时 为 止 ; 第 2 重 模式 是 用 随机 行走 来 设法 避 开 局 部 
最 小 值 ; 第 3 重 模式 是 当 多 次 避 开 局 部 最 小 值 的 努力 
都 已 失败 时 ， 执 行 回溯 法 。 这 种 方法 在 许多 情况 下 被 
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图 5.8 引力 和 斥 力 分 量 定义 势 函数 


看 作 是 基于 抽样 的 规划 ， 它 也 提供 了 弱 完 整 性 保证 ， 
但 需要 参数 调整 。 近 来 基于 抽样 的 方法 达到 了 更 好 的 
性 能 ， 它 主要 通过 花费 更 多 时 间 进 行 空间 搜索 ， 而 不 
是 将 重点 放 在 势 函数 上 。 

势 函 数 的 梯度 也 能 用 于 定义 矢量 场 ， 它 可 在 任意 
构 型 ge C 上 对 机 器 人 指定 一 个 运动 。 这 种 方法 的 主 
要 优点 不 仅 限 于 其 计算 效率 ， 因 为 它 不 只 是 一 个 单一 
的 路 径 计算 ,也 是 一 个 反馈 控制 策略 ， 这 使 得 方法 更 
具 和 鲁 棒 逆 向 控制 和 传 感 误差 。 反 馈 运 动 规划 技术 大 多 
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机 器 人 路 径 
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图 5.9 势 函数 求解 局 部 最 小 问题 的 两 个 例子 


是 基于 导航 函数 的 思想 “” ， 芭 合 理 构造 势 函 数 ， 使 
之 只 有 单一 最 小 值 。 函 数 D: Cr. -[0, 1] 称 为 导航 
KA, WRC: 

1) EFR (REDE be? 的 C 上 平滑 )。 

2) 在 qc 处 具有 唯一 最 小 值 ，C 空间 的 连接 分 量 
包含 Woo 

3) 在 C 空间 的 边界 上 具有 均匀 最 大 值 。 





图 5. 10 球形 空间 和 星 形 空间 示例 


4) HX Morse, BIBT ARIA (ane) 是 
孤立 的 ， 可 通过 小 随机 扰动 加 以 避免 。 

如 图 5. 10 所 示 ， 对 于 只 包含 球形 障碍 物 的 情况 ， 
导航 函数 可 以 构建 成 球 心 为 9 的 球 边界 空间 。 然 后 它 
们 还 可 扩展 到 微分 同 胚 于 球 空间 的 大 的 C 空间 族 ， 
例如 图 5. 10 所 示 的 星 形 空间 。 反 馈 运 动 策略 的 详细 
阐述 见 本 书 的 第 3$ 、 第 36 和 第 37 章 。 

除了 局 部 最 小 问题 之 外 ， 对 于 势 函 数 方法 ， 
男 一 个 主要 的 挑战 是 如 何 构 建 并 表示 C 空间 ， 这 
一 难题 使 得 在 高 维 问题 中 ,该 技术 的 应 用 显得 过 
于 复杂 。 


5.4 微分 约束 


机 器 人 运动 通常 必须 符合 全 局 和 局 部 两 种 约束 ， 
ECE, 全 局 约束 以 障碍 物 和 关节 限 位 形式 加 以 考 
虑 ; 局 部 约束 则 通过 微分 方程 进行 模拟 ， 因 而 称 作 微 
分 约束 。 出 于 运动 学 考虑 ( 如 轮 的 接触 点 ) 和 动力 
学 考虑 (如 动量 矩 守 恒 )， 约束 方程 限定 了 每 个 点 的 
速度 及 可 能 的 加 速度 。 


5.4.1 概念 和 术语 


设 4 为 速度 矢量 ,C 上 的 微分 方程 可 表示 成 隐 式 


形式 g,(q，9 ) =0， 或 者 参数 形式 x =f(q, u), BA 
式 形式 更 为 一 般 ， 但 往往 更 难于 理解 和 利用 。 在 参数 
形式 中 ,矢量 值 方程 预示 速度 要 通过 给 定 的 9 和 w 来 
求 ， 其 中 为 输入 ， 选 自 于 某 些 输入 空间 U ET 
示 时 间 间 隔 ， 并 从 :=0 时 刻 开始 。 

为 模拟 动力 学 问题 ， 需 要 将 概念 扩充 到 C 空间 
的 相 空间 和 上 。 通 常 每 个 点 xe 六 表示 构 型 和 速度 ， 
即 x = (q，4 )。 采 用 隐 式 形式 和 参数 形式 都 可 能 ， 
分 别 表示 为 g:(x，x) =0 和 x =f(x, u), 后 者 为 一 


种 常见 的 控制 系统 的 定义 。 注 意 x =(g，4 ), 这 
预示 着 可 以 对 加 速度 约束 和 完整 系统 动力 学 进行 
表达 。 

在 状态 空间 兰 中 进行 规划 ， 可 引出 对 对, 的 直接 
EX: 对 于 x = (q，4 )， 当 且 仅 当 g e Catt, A 
Xe 处 so。 然而 ,还 存在 男 外 一 种 可 能 性 ， 它 基于 必 
然 碰撞 区 域 概念 ， 能 直观 地 反映 动力 学 的 规划 问题 ， 
其 定义 如 下 : 


不 = {x(0) eX |for any u e Un, 
4t>0 such that x(t) EX, | , 


o 


(5.4) 
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式 中 , x(t) 为 1 时刻 的 状态 ,可 通过 控制 函数 u: 
TU， 从 x(0) 积分 得 到 ; Up 为 预先 确定 的 所 有 可 
能 控制 函数 的 集合 ; Xe 表示 这 样 一 个 状态 集 : EE 
十 面 机 器 人 会 发 生 碰撞 ; 或 者 由 于 动量 的 缘故 ， 不 能 
避免 发 生 碰 撞 ， 如 图 5. 11 所 示 。 它 可 被 视 为 一 种 无 
形 的 障碍 区 域 ， 并 随 速 度 增 大 而 增长 。 


q <0 





X ric 


图 5.11 必然 碰撞 区 随 速 度 呈 平方 关系 增长 


在 微分 约束 规划 的 总 标题 下 ， 有 许多 重要 的 问题 
类 别 ， 大 量 研 究 文 献 已 对 此 加 以 关注 。 在 轮 式 移动 机 
器 人 的 研究 中 ， 引 入 了 非 完 整 性 规划 的 术语 ““' ， 举 
个 简单 的 例子 : 由 于 汽车 不 能 侧面 移动 ， 从 而 使 平行 
泊 停 车 变 得 困难 。 一 般 情况 下 ， 非 完整 约束 为 微分 等 
式 约 束 ， 不 能 积分 成 不 含 导 数 项 的 约束 形式 。 机 器 人 
学 中 出 现 的 典型 非 完 整 性 约束 ， 可 以 是 车 轮 接 触 等 运 
动 学 引起 的 “| ， 也 可 能 是 起 因 于 动力 学 。 

如 果 包 含 约束 的 规划 问题 中 ， 至 少 涉及 速度 和 加 
速度 ， 该 问题 常 被 称 为 kinodynamic WRS 。 通 常 
模拟 成 全 驱动 系统 ， 表 示 为 9 =h(qg，g ,uw)， 其 中 
U 为 包括 民 ” 原 点 的 一 个 开 集 (这 里 是 U ACHE 
数 ) 。 约 束 问 题 可 能 既是 非 完 整 的 ， 又 是 kinodynamic 
问题 ， 或 者 二 者 都 不 是 ; 然而 日 前 该 项 还 没有 更 精确 
的 表示 。 
轨迹 规划 是 另外 一 个 重要 概念 ， 它 主要 用 于 确定 

机 .器 手 的 路 径 和 速度 函数 问题 (如 PUMAS60) 。 在 下 
面 的 处 理 中 ， 所 有 这 些 都 称 作 微 分 约束 规划 。 


5.4.2 约束 的 离散 化 


在 微分 约束 下 ， 对 有 障碍 存在 的 完备 性 及 最 优 规 
LM, MAKE YR OMA X= RS 双 积 
分 系统 。 为 研发 这 方面 的 算法 ， 通 常 需 要 进行 一 些 离 
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散 化 处 理 。 对 于 普通 运动 规划 ， 只 有 @ 需 要 离散 ; 对 
于 微分 约束 ， 除 了 @ (RX) Sb, TAU (TAE) 也 
需要 离散 化 。 

微分 约束 的 离散 化 是 最 重要 的 问题 之 一 。 为 了 有 
效 地 求解 具有 挑战 性 的 规划 问题 ， 通 常 需要 对 特定 的 
动力 学 系统 ， 定 义 运动 图 元 “”%%1。 对 微分 约束 进 
行 离散 ， 一 种 最 简单 的 方法 是 构造 离散 时 间 模 型 ， 它 
具有 三 个 方面 的 特点 : 

1) 将 时 间 区 间 了 划分 为 长 度 为 Ai 的 时 间 间 隔 。 
这 样 时 间 就 分 成 多 个 阶段 ， 其 中 天 阶段 预示 (Ck -1) 
Ar 的 时 间 已 经 过 去 。 

2) 选择 动作 空间 上 的 一 个 有 限 子 集 U WR U 
已 经 是 有 限 的 ， 则 可 选择 U =U. 

3) 在 每 个 时 间 步 内 ,动作 w(t) 必须 保持 为 
常数 。 

从 初始 状态 x 开始 ， 运 用 离散 动作 的 所 有 序列 ， 
形成 可 达 树 。 图 5. 12 显示 了 Dubins 车 上 这 种 树 的 路 
径 ， 它 是 一 个 小 车 的 运动 学 模型 ， 该 小 车 以 单位 速度 
在 平面 上 行 怠 ， 且 不 能 反 向 运动 ， 树 的 边线 为 贺 弧 和 
线段 。 对 于 常规 系统 ， 当 x 给 定时 ， 树 上 的 每 个 轨迹 
Be, Wh x =f(x, u) 的 数值 积分 来 确定 。 通 常 这 可 
视 作 一 个 增 量 模拟 器 ， 它 获取 一 个 输入 后 ， 根 据 x = 
f(x, u) 产生 一 个 轨迹 段 。 








2 阶段 4 阶段 
图 5.12 三 动作 Dubins 车 的 可 达 树 ， 
第 天 阶段 产生 3 个 新 顶点 


5.4.3 解 耦 方法 

对 于 轨迹 规划 等 涉及 动力 学 的 问题 ， 流 行 的 算法 
是 先 将 问题 解 耦 为 路 径 规 划 ， 再 沿 着 路 径 计算 计时 函 
数 ， 这 一 步 通过 对 (s，s ) 空间 跨 距 进 行 搜索 来 实 
M, Hp s, 是 路 径 参数 ，s 为 其 一 阶 导数 。 由 此 可 得 
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到 图 5.13， 图 的 上 部 So. 区域 是 必须 要 避免 的 ， 因 为 
其 上 机 械 子 系统 的 运动 违反 了 微分 约束 条 件 。 目 前 大 
多 数 方法 都 还 是 基于 文献 (5.68, 69] 等 早期 工作 ， 
用 来 确定 bang-bang 控制 ， 这 意味 着 要 在 全 速 下 进行 
加 速 和 减速 的 切换 。 一 旦 对 路 径 进行 约束 ， 该 方法 可 
用 于 确定 时 间 最 优 轨 迹 。 此 外 ， 动 力学 规划 还 可 用 于 
更 为 广泛 的 问题 中 , 





图 5. 13 bang-bang 方法 计算 时 间 最 优 轨 迹 ， 
通过 连接 图 上 的 点 得 到 求解 轨迹 


对 某 些 约束 问题 和 非 完 整 系统 ， 导 向 法 已 发 展 到 
可 用 于 有 效 求解 两 点 的 边 值 问题 ““… 。 这 意味 着 ， 
对 于 任意 的 状态 对 ， 可 以 获得 一 条 忽略 障碍 本 身 但 满 
足 微分 约束 的 运动 轨迹 。 此 外 ， 对 于 某 些 系统 ， 已 经 
得 到 了 最 优 轨迹 特征 的 完备 集 “””。 这 些 基 于 控制 
的 解 看 方法， 能 直接 适用 于 基于 抽样 的 路 线 图 方 
法 “”“” ,其 中 一 种 解 看 方法 是 ， 先 在 忽略 微分 约束 
的 情况 下 ， 规 划 出 一 条 路 径 ， 然 后 逐渐 将 它 变换 为 满 
足 约 束 的 形式 和 62,76] n 


5.4.4 kinodynamic 规划 


由 于 微分 约束 下 的 规划 难度 很 大 ， 因 此 许多 成 功 
的 基于 抽样 的 规划 算法 是 在 相 空间 互 上， 直接 处 理 
kinodynamic 问题 。 

基于 抽样 的 规划 算法 ， 通 过 对 一 个 或 多 个 可 达 树 
来 进行 搜索 ， 在 搜索 网 格 时 ， 可 画 出 许多 平行 线 。 但 
对 于 可 达 树 则 更 为 复杂 ， 因 为 它们 涉及 的 不 一 定 都 是 
规则 的 点 阵 结 构 。 大 多 数 情况 下 ， 在 可 达 树 的 顶点 位 
置 处 ， 点 会 非常 密集 ， 因 此 在 固定 分 辨 率 下 ， 无 法 
清晰 地 实现 对 有 界 区 域 的 详细 搜索 。 男 外 也 很 难 
设计 成 这 样 一 种 方法 ,使 其 成 为 一 个 多 分 辨 率 网 
格 ， 其 精度 可 任意 调整 ， 以 确保 分 辩 率 的 完备 性 。 


许多 算法 尝试 将 可 达 树 转换 为 点 阵 形 式 ， 这 正 是 
原始 kinodynamic 规划 工作 的 基础 “” ， 其 中 离散 时 
闻 的 近似 二 重 积 分 9 =u, 需要 加 到 网 格 上 ， 如 图 
5. 14 所 示 。 这 使 得 可 开发 一 种 近似 算法 来 求解 Kino- 
dynamic 规划 问题 ,算法 中 时 间 多 项 式 等 于 近似 量 
1/e ， 并 采用 图 元 数 来 定义 障碍 物 。 对 于 全 驱动 系 
统 ， 普 适 化 的 方法 描述 见 参考 文献 [5.77]。 令 人 惊 
异 的 是 ， 该 方法 对 于 某 些 欠 驱动 的 非 完整 性 系统 ， 其 
至 也 能 得 到 点 阵 结构 ““” 。 





图 5.14 从 原点 开始 的 可 达 图 ， 经 过 3 个 阶段 后 的 示例 
( 当 加 速 或 减速 发 生 时 ， 真 实 的 边线 将 是 抛物 线 ) 
(注意 虽然 得 到 了 点 阵 结构 ,但 在 第 一 阶段 


行进 距离 会 随 着 | q | 的 增加 而 增 大 ) 


如 果 可 达 树 不 能 形成 点 阵 〈 网 格 ) ， 一 种 方法 是 
强制 在 下 (BRC) 上 进行 规则 单元 分 解 ， 且 只 允许 每 
个 单元 的 一 个 点 通过 可 达 图 进行 扩展 ， 如 图 5.15 所 
示 。 参 考 文献 [5.78] 中 介绍 了 这 一 思想 ， 他 们 通 
过 动力 学 规划 ， 来 完成 可 达 图 的 扩展 。 每 个 单元 最 初 
标记 为 有 碰撞 或 无 碰撞 ， 但 并 不 访问 ; 当 搜 索 中 访问 
单元 时 ， 也 要 这 样 进行 标记 ; 如 果 一 个 新 顶点 落 和 人 到 
访问 过 的 单元 ， 将 不 被 保存 ; 这 具有 修剪 可 达 树 的 
效果 。 

其 他 相关 的 方法 并 不 强制 可 达 树 形成 网 格 。 快 速 
搜索 随机 树 (RRT) 方法 设计 为 用 这 样 的 方式 进行 
扩展 树 : 在 每 步 迭 代 中 ， 偏 问 尽 可 能 多 地 窗 盖 新 区 
BRIS?) 。 基 于 扩展 树 概 念 的 规划 ， 力 图 通过 分 析 邻 域 
来 控制 树 上 的 顶点 密度 ““] 。 有 向 路 径 细 分 树 规 划 进 
行 扩展 时 ， 同 时 建立 状态 空间 的 自 适 应 分 割 ， 以 避免 
在 同一 空间 区 域 再 次 采样 “i 。 这 些 方法 能 偏 于 加 
快 树 向 目标 的 扩展 ， 同 时 还 提供 了 弱 概 率 完备 性 
保证 “1 。 ; 
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图 5.15 规则 单元 分 解 
a) Dubins 车 最 初 4 个 阶段 的 密集 可 达 图 b) 让 每 个 单元 至 多 只 有 一 个 项 点 ， 
前 掉 许 多 分 支 后 ， 得 到 的 一 个 可 能 搜索 图 (本 例 中 没有 沿 6 轴 的 单元 分 离 ) 


5.5 扩展 与 变化 


本 节 简 要 回顾 基本 运动 规划 问题 的 一 些 其 他 重要 
的 扩展 。 


5.5.1 闭 式 运动 链 


在 许多 情况 下 ， 本 器 人 可 能 由 连 杆 通过 闭环 形式 
组 成 。 这 方面 有 许多 重要 应 用 ， 如 两 臂 抓 住 同一 个 物 
体 ， 则 形成 了 一 个 环 ; 又 如 人 形 机 器 人 双 脚 触 地 ， 也 
形成 一 个 环 。 对 于 并 联机 器 人 ,还 有 意 设计 成 
环 "1 ， 其 经 典 的 例子 为 Stewart- Grough 平台 。 为 模 
拟 闭 链 问题 ， 就 要 将 环 打 开 以 便 得 到 连 杆 的 运动 树 。 
主要 的 复杂 性 是 C 上 引信 了 hl(q) =0 形式 的 约束 ， 它 
要 求 对 环 进行 保留 ， 这 对 于 大 多 数 规 划算 法 来 说 遇 到 
了 很 大 麻烦 ， 因 为 没有 环 的 G@ 参 数 是 可 用 的 。 闭 环 约 
束 只 能 将 规划 限制 在 无 给 出 参数 的 低 维 C 子 集 上 ， 因 
为 计算 参数 一 般 很 困难 或 根本 不 可 能 ， 尽 管 对 某 
些 特殊 情况 ， 也 取得 了 一 定 进展 “” 。 

基于 抽样 方法 能 广泛 适用 于 处 理 封 闭 链 问 题 。 其 
主要 困难 在 于 , CG 上 的 样本 a(i) 的 构 型 不 太 容 易 满足 
封闭 性 。 在 参考 文献 [5. 84] 中 ，RRT 和 PRM 都 能 
适用 于 封闭 链 ， 而 RRT 更 好 ， 这 是 因为 在 PRM 中 ， 
将 样本 移 到 封闭 子 空间 时 ， 要 付出 较 高 的 优化 代价 ， 
mi RRT 不 需要 样本 进入 子 空间 。 对 于 参考 文献 
[5.85] 中 的 PRM 算法, 将 链 路 解 看 成 主动 链 和 被 
动 链 ， 接 下 来 通过 道 向 动力 学 计算 ， 能 极 大 地 提升 该 


方法 的 性 能 。 引 人 入 随机 闭环 发 生 器 (RLG) 后 ， 该 想 
法 得 到 了 进一步 的 改进 。 在 此 基础 上 ，_- 些 更 具 挑战 
性 的 闭 链 规 划 问 题 ， 其 求解 方法 见 参考 文献 
[5.86], 


5.5.2 操作 规划 


在 大 多 数 形式 的 运动 规划 中 ， 机 器 人 是 不 允许 接 
触 障碍 物 的 。 假 设 改 为 期 望 通过 操作 对 象 与 环境 交互 
作用 ， 其 目标 可 能 是 将 物体 从 一 个 地 方 转移 到 另外 地 
方 ， 或 者 重新 对 目标 进行 整理 收集 ， 这 将 导致 出 现 一 
类 混合 运动 规划 问题 : 它 混合 了 离散 空间 和 连续 空 
间 。 离 散 模式 对 应 于 机 器 人 是 否 正在 搬运 部 件 
(part) "1 ， 在 过 境 模式 中 ， 机 器 人 向 着 部 件 运动 ， 
在 转移 粳 式 中 ， 机 器 人 搬运 部 件 。 两 种 模式 之 间 的 转 
换 需 要 满足 特定 的 抓 取 和 稳定 性 条 件 。 装 配 规划 是 一 
种 重要 的 操作 规划 的 变 体 ， 其 目标 是 将 各 个 部 件 安装 
在 一 起 ， 使 之 成 为 一 件 装配 产品 5 吹 。 大 部 分 运动 规 
划 工艺 ， 都 对 机 器 人 与 对 象 之 间 的 各 种 交互 作用 ， 作 
了 限制 性 假设 。 更 为 丰富 的 操作 规划 模型， 参见 参考 
文献 [5.89]. 


5.5.3 时 变 问题 


假设 工作 空间 包含 移动 障碍 物 ， 其 轨迹 为 时 间 的 
函数 。 设 TCR 表示 时 间 区 间 ， 它 可 能 有 界 ， 也 可 能 
ER. RSX ZLAX=CxT, HP CREN A NAL 
器 人 C 空间 。 下 中 的 障碍 区 域 表 示 为 


X,,, =| (q,t) eX|A(q) NO(t) 4B} (5.5) 
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AF, O(t) 为 时 变 障 碍 。 许 多 规划 算法 均 适 用 于 际 ， 
ERE CAE, 问题 的 主要 复杂 性 在 于 时 间 必 须 始 
终 沿 者 过 下 的 路 径 增 加 。 

对 这 个 问题 最 简单 的 算法 版 本 是 对 机 器 人 没有 
速度 限制 。 在 这 种 情况 下 ， 几 乎 所 有 的 基于 抽样 算 
法 均 适 用 ， 除 了 路 径 是 有 加 的 以 便 安排 时 间 进 程 外 ， 
增 量 搜索 和 抽样 方法 也 几乎 不 加 修改 就 能 应 用 。 对 
于 时 变 问 题 ， 采 用 双 困 方法 则 比较 困难 ， 因 为 由 于 
时 间 的 依赖 性 ， 目 标 通常 不 是 一 个 不 动 的 单一 点 。 
基于 抽样 的 路 线 图 虽然 也 可 以 使 用 ， 但 需要 采用 有 
向 路 线 图 ， 其 中 必须 对 每 条 边线 定向 ， 使 其 产生 时 
间 单 调 路 径 。 

如 果 运 动 模型 是 代数 的 〈《 即 表达 式 为 多 项 式 ) ， 
W 瑟 是 半 代 数 的 ， 它 可 以 采用 柱 形 代 数 分 解 。 如 图 
5.16 Bras, WR XX,. 为 多 面体 ， 则 可 使 用 垂直 分 解 。 
最 好 是 先 沿 着 了 轴 扫 描 平 面 ， 当 线性 运动 改变 时 ， 则 
在 临界 时 间 上 停止 。 











Ciee ( fi ) Chive (1 2) 


Chee ( 13) 


图 5.16 线性 障碍 运动 的 时 变 实 例 


机 器 人 移动 避 障 问题 中 ， 迄 今 为 止 还 没有 对 速度 
加 以 考虑 。 显 然 如 果 求 解 结果 是 需要 机 器 人 以 任意 快 
的 速度 移动 ， 这 在 许多 应 用 中 并 不 合 切实 际 。 为 朝 着 
构造 现实 模型 发 展 ， 第 一 步 就 是 要 对 机 器 人 的 速度 做 
出 限制 ， 然 而 令 人 焉 憾 的 是 ， 这 个 问题 相当 复杂 ， 即 
便 是 平面 障碍 的 分 段 线 性 运动 ， 这 一 问题 的 难度 级 别 
已 属于 PSPACE- hard*” 。 此 外 ， 参 考 文献 [5.91] 
提出 了 基于 最 短路 径路 线 图 的 完备 性 算法 。 

一 种 替代 方案 是 将 问题 定义 在 C KT 上 ， 并 解 耦 
为 路 径 规 划 部 分 和 运动 时 序 部 分 。 首 先 计算 缺少 障碍 
物 时 的 无 碰撞 路 径 规划 ， 然 后 通过 对 路 径 确 定 计时 郴 
数 〈 时 间 尺 度 ) 完成 二 维 空间 的 搜索 。 


机 器 人 学 基础 


5.5.4 多 机 器 人 系统 


对 基本 运动 规划 问题 做 些 简单 扩展 ， 就 能 用 于 处 
理 包 括 目 相交 在 内 的 多 体 机 器 人 问题 ， 然 而 重要 的 是 
要 指定 刚体 对 之 间 哪 些 碰撞 是 不 能 接受 的 。 例 如 ， 机 
械 臂 的 连续 连 杆 则 是 允许 接触 的 。 
多 机 器 人 系统 的 运动 规划 问题 一 直 倍 受 关 注 。 假 
设 有 克 个 机 器 人 ， 同 时 考虑 所 有 机 器 人 的 构 型 ， 其 
状态 空间 定义 为 : 
A= C! x Ct Cn (5. 6) 
KAS xe XH AMARA WH, WRK Ax = 
(a, C, e, g”), XH#RBAN, 其 中 NN = 
>, _,dim(C) a 
在 状态 空间 中 ， 障 碍 区 域 的 来 源 有 两 个 : DBL AE 
人 -障碍 物 碰撞 ; 凶 机 器 人 -机 器 人 碰撞 。 对 每 个 i， 
l<i<m, 在 与 障碍 区 域 @ 冲 突 时 ， 对 应 于 机 器 人 A 
的 着 子 集 为 
X= {xeX|Ai(g’) NOB! 
此 模型 属于 机 器 人 -障碍 物 碰撞 。 
XTOLAEA RIER Ai Al A, ANB ABSENT, OFAN 
I X FARA 
Xin. = (xe X|A(g')NA(g’) 20 (5.8) 
合并 式 (5.7) 和 式 (5.8) 到 式 (5.9)， 可 得 到 天 
中 的 障碍 区 域 下 ,为 


X obs = | U Xin) U | WX) 
net fir) 


一 旦 给 出 了 这 些 定义 ， 任 何 通用 的 规划 算法 都 可 
以 使 用 ， 因 为 除了 维 数 N AT REIR Sb, XA X 
C 和 Cws 并 无 不 同 。 直 接 在 著 上 进行 规划 的 方法 称 为 
集中 。 考 的 高 维 问题 促进 了 解 耦 方法 的 发 展 ， 用 于 对 
每 个 机 器 人 独立 规划 方面 的 问题 进行 处 理 。 解 耦 方法 
通常 更 为 有 效 ， 但 往往 以 牺牲 完备 性 为 代价 。 早 期 的 
解 耦 方法 为 优先 规划 “”” ， 其 中 看 对 第 i 个 机 器 人 
计算 路 径 和 计时 函数 时 ,将 前 面 的 i-1 个 机 器 人 处 
理 为 沿 其 路 径 移动 的 障碍 物 。 男 一 种 解 克 方 法 是 固定 
路 径 协调 方法 ， 它 对 每 个 机 器 人 独 芯 规划 路 径 ， 然 后 
通过 m 维 协调 空间 计算 无 磁 撞 路 径 ， 再 确定 计时 也 
数 。 在 协调 空间 上 ， 每 个 轴 对 应 于 一 个 机 器 人 路 径 定 
义 域 ， 图 $. 17 为 一 个 示例 。 这 一 思想 已 被 推广 到 路 
线 图 的 协调 问题 中 “| 。 


5.5.5 预报 不 确定 性 


如 果 执 行 的 规划 是 不 可 预报 的 ， 则 需要 进行 反馈 
处 理 。 不 确定 性 可 模拟 为 隐 式 的 ， 意 味 着 规划 能 对 将 


(S57) 


(5.9) 
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坐标 数 为 m 的 机 器 人 ， 其 障碍 空间 通常 
为 柱 形 ， 全 部 十 m( m+1 ) 个 轴 对 齐 的 二 维 
投影 集 ， 反 映 了 Xo 的 完备 性 特性 


图 5. 17 


来 未 预料 的 构 型 作出 响应 ; 或 者 为 显 式 的 ， 表 示 不 确 
定性 特点 已 在 规划 中 做 了 分 析 。 基 于 势 国 数 的 方法 ， 
是 实现 反馈 运动 规划 的 一 种 方式 。 

规划 可 表示 为 Cree 上 的 一 个 矢量 场 ， 其 中 每 个 
矢量 表示 要 求 的 速度 。 矢 量 场 的 积分 曲线 在 不 离 
FF Co 的 前 提 下 ， 应 该 流入 到 目标 上 。 如 果 与 动力 
学 有 关 ， 则 矢量 场 可 由 基于 加 速度 的 控制 模型 来 
追踪 : 

u=K( f(q)-4) +V;f(q) (5. 10) 
AF, 天 为 标量 形式 的 增益 常数 〈 放 大 系数 ) PA 
地 ， 可 在 相 空 间 关上 直接 设计 速度 场 ,但 在 一 般 条 
件 下 ， 还 没有 能 够 有 效 计算 这 种 场 的 方法 。 别 处 也 可 
以 将 反馈 控制 问题 考虑 为 带 有 隐 式 的 、 革 上 的 非 线 性 
约束 。 

如 果 不 确定 性 模拟 为 显 式 的 ， 则 可 得 反目 然 博 弈 
问题 ， 其 中 由 特别 决策 者 引起 的 不 确定 性 称 为 自然 ， 
自然 的 决策 可 模拟 为 非 定 党 的， 这 表示 指定 了 一 组 可 
能 的 动作 ; 或 者 为 概率 性 的 ， 这 表示 指定 了 自然 动作 
的 概率 分 布 (或 概率 密度 )。 在 非 定 常 不 确定 性 下 ， 
通常 运用 最 坏 情况 分 析 来 选择 规划 ; 在 概率 不 确定 性 
下 ,通常 运用 期 望 情况 分 析 。 对 这 类 问题 的 分 析 方 法 
很 多 ， 其 中 包括 估 值 迄 代 、Dijkstra- like 算法 ， 强 化 
woe 。 


5.5.6 传 感 不 确定 性 


考虑 有 限 传 感 下 解决 定位 、 地 图 构建 、 操 作 、 
HERIR, ARIER (RM) 等 任务 。 如 果 在 执 
行 过 程 中 ， 当 前 构 型 或 状态 是 未 知 的 ， 则 问题 会 变 
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ASAE AS AE. Meme RRS, FAA Ray A 
到 信息 空间 (或 1 空间 ， 见 参考 文献 [5.7] 的 第 
11 章 ) 。 状 态 量 可 能 包括 构 型 、 速 度 黄 至 环境 地 图 
(如 障碍 物 ) 。 最 基本 的 I 空间 就 是 在 执行 过 程 中 获 
得 的 所 有 历史 数据 集 ， 这 些 数 据 包 括 所 有 传 感 观测 、 
以 前 的 动作 ， 以 及 初始 条 件 。 本 文 开 展 有 效 算法 的 
目的 ， 是 为 了 确定 信息 映射 ， 从 而 减 小 1 空间 的 下 
度 和 复杂 度 ， 以 便 在 采用 信息 反馈 进行 规划 时 便于 
计算 。 传 统 方式 采用 信息 状态 来 作为 估计 状态 ， 这 
对 于 许多 任务 的 求解 是 充分 的 ， 但 通常 是 不 必要 的 。 
有 可 能 设计 并 成 功 执行 一 项 规划 ， 而 甚至 不 用 知道 
当前 的 状态 ， 这 会 导致 出 现 更 多 的 角 棒 性 机 器 人 系 
统 ， 它 们 由 于 降低 了 传 感 要 求 ， 因 而 制造 成 本 会 更 
便宜 。 对 于 与 此 话题 相关 的 更 多 材料 ， 可 参阅 本 书 
第 3 篇 的 章节 。 


本 节 涵 盖 了 一 系列 更 加 高 级 的 问题 ， 例 如 拓扑 结 
HAREE, WARE A ilies Bh AR ae A AE BE R A 
最 后 一 小 节 将 专门 讨论 代数 几何 计算 技术 ， 用 于 实现 
一 般 情 况 下 的 完备 性 ， 而 不 是 讨论 实用 性 问题 ， 作 为 
一 个 上 界 ， 用 以 获取 最 佳 泗 进 运行 时 间 。 


5.6.1 构 型 空间 的 拓扑 


1. HÉ 

C 空间 拓扑 重要 的 一个 原因 是 它 影响 表示 法 ; 另 
_ 个 原因 是 ， 如 果 路 径 规划 算法 能 在 拓扑 空间 求解 问 
B, 那么 该 算法 可 结 转 到 拓扑 等 价 空间 上 。 

为 了 描述 C 空间 的 拓扑 ， 有 如 下 重要 定义 ; we 
Sjo: SOT RON (RIMES), WE 6 SOU, E 
由 和 由 -: 都 连续 。 当 这 样 一 个 映射 存在 时 ，S 和 了 被 
称 为 是 同 胚 的 。 如 果 对 民 * 局 部 同 胚 ， 集 合 5 为 一 个 
n 维 流 形 ， 这 意味 $ 上 的 每 个 点 拥有 一 个 邻 域 ， 对 
R° 是 同 胚 的 。 更 多 详情 参见 参考 文献 . [5.97，98]。 

在 绝 大 多 数 运动 规划 问题 中 ， 构 型 空间 是 一 个 流 
形 。C 空间 不 是 流 形 的 例子 是 ， 封 闭 的 单位 正方 形 ; 
-0，1] x [0，1] CR:， 它 是 通过 将 一 维 边界 粘贴 到 
二 维 开 集 (0，1) x (0，1) E, 而 得 到 的 一 个 带 边 
流 形 。 当 C 空间 是 一 个 流 形 时 ， 则 恰好 可 以 用 个 参 
数 来 表示 它 ， 其 中 是 构 型 空间 的 维 数 。 尽 管 一 个 n 
维 流 形 可 以 采用 尽 可 能 少 的 n 个 参数 来 表示 ， 但 由 于 
约束 条 件 ， 它 可 能 更 方便 采用 高 维 参数 表示 法 。 例 
如 : 单位 圆 可 通过 将 S' 柑 和 人民 *， 表 示 为 S' -= | (x, 
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y) +y =1}, UH, BAB PARAR 3 。 

2. 表示 法 

嵌入 到 更 高 维 的 空间 可 以 方便 C 空间 的 许多 操 
作 。 例 如 空间 中 刚体 的 姿态 (方位) 可 用 nxn 的 实 
数 和 矩阵 表示 ; 半 和 矩阵 必定 满足 一 个 光滑 等 式 约 束 数 ， 
使 得 这 个 矩阵 的 流 形 为 RR” 的 子 流 形 。 一 个 优点 是 这 
些 矩 阵 在 流 形 中 相 乘 得 到 另外 一 个 矩阵 ， 例 如，m HE 
空间 (n=2 或 3) 中 刚体 的 姿态 可 用 SO(n) 描述 ， 
这 里 SO(n) AMA nxn 旋转 矩阵 的 集合 。 刚 体 的 位 
姿 (位 置 和 姿态 ) 可 用 SE(n) 表示 ,这 里 SE(n) 
为 所 有 nxn 个 齐 次 变换 矩阵 。 这 些 矩 阵 群 可 用 于 : 
全 表示 刚体 构 型 ; @@ 改 变 用 于 构 型 表示 法 的 坐标 系 ; 
@ 置 换 构 型 。 

确定 S0(3) 参数 的 方法 很 多 !* ”但 当 用 S' 表 
示 二 维 旋转 时 ， 单 位 四 元 素 保 持 了 C 空间 的 拓扑 。 
四 元 素 已 在 第 一 章 做 过 介绍 ， 而 这 里 单位 四 元 素 和 三 
维 旋转 矩阵 间 有 一 个 2 对 1 的 对 应 关系 ， 这 使 得 拓扑 
问题 类 似 于 二 维 旋转 中 0 和 2 等 价 问题 ， 解 决 的 办 
REPS 上 对 极点 是 等 价 的 。 在 规划 中 ,只 有 全 
的 上 半球 是 需要 的 ， 而 且 穿 越 赤 道 的 路 径 ， 瞬 间 会 重 
新 出 现在 的 对 面 ， 回 到 北半球 。 在 拓扑 当中 ， 这 
称 为 实 射影 空间 : RP。 因此 三 维 物体 的 C 空间 上 ， 
只 有 转动 是 民 忆 。 如 果 平 动 和 转动 都 允许 ， 则 为 
SE(3)， 即 所 有 4 x4 齐 次 变换 矩阵 ， 得 

C=R xRP (5.11) 

它 是 6 维 的 。 构 型 ge C 可 采用 带 有 7 个 坐标 (2, Y, z, 
a, b, c, d) 的 四 元 素 表 示 ， 其 中 a +b te +d =i, 


5.6.2 抽样 理论 


因为 现今 对 于 运动 规划 最 成 功 的 算法 都 是 5.2 节 
提出 的 基于 抽样 的 构架 ， 抽 样 理论 已 成 为 运动 规划 的 
相关 问题 。 

1. 构 型 /状态 空间 中 的 和 矩阵 

事实 上， 所 有 基于 抽样 的 方法 ， 都 需要 在 @ 上 定 
义 某 种 距离 。 例 如 ， 基 于 抽样 的 路 线 图 方法 ， 给 定 一 
个 用 距离 定义 的 邻 域 ， 选 择 候选 顶点 去 连接 一 个 新 构 
型 。 类 似 的 ， 快 速 搜索 密集 树 方法 ， 从 最 近 的 树 节 点 
将 树 扩展 到 一 个 新 的 样本 构 型 。 通 常 ， 定 义 一 个 度量 
p:Cxe 一 R， 它 满足 标准 公理 : 非 负 性 、 自 反 性 、 
对 称 性 和 三 角 不 等 式 。 

在 构建 度量 时 出 现 了 两 个 难题 : 外 C 的 拓扑 结构 
必须 遵守 ; 外 个 别 不 同 的 量 ， 如 线 位 移 和 和 角 位 移 ， 必 
须 以 某 种 方式 进行 比较 。 为 了 说 明 第 二 个 问题 ， 在 
Z=XxY 空间 上 ， 定 义 一 个 度量 p,， 





p.(z, z) =p.(x, Y, x’, y') 
=p, (x, x") +p, (Y, y) (5.12) 
AF, ¢ 和 口 是 任 意 的 正常 数 ， 代 表 两 个 分 量 的 相关 
权重 。 对 于 二 维 旋转 & ， 表 示 为 ai =cos6,, b, = sing,， 
则 可 用 的 度量 为 
pla, bi, a, b,) = cos ` (a, a, +b,b,) (5.13) 
通过 如 下 定义 可 得 到 三 维 等 价 量 
pyo(h,, h,) =cos (aa, +b,b, +e,c, +d, d,) 
(5.14) 
A, Ah, = (a b co di) 是 一 个 单位 四 元 素 。 
通过 各 日 的 双 极 点 辨识 ， 度量 定义 为 p(h，h,) = 
min(py(h,, Ay), Pohi, -hh,))。 对 于 单位 球 上 的 
HIAR, ER PAREEK, 
在 一 些 算法 中 ， 在 @ 上 定义 体积 可 能 也 很 重要 。 
这 通常 需要 引 人 和 人 一 个 测度 空间 ， 对 每 一 个 体积 函数 
( 称 为 测度 ) 必须 满足 类 似 于 概率 公理 的 这 样 一 些 公 
理 ， 但 不 需要 归 一 化 。 对 于 每 个 变换 ， 必 须 仔细 以 这 
样 的 方式 来 定义 体积 ， 即 它 关 于 变换 为 不 变量 ， 这 个 
体积 称 作 Haar 测度 。 采 用 度量 的 定义 式 (5.13) 和 
式 《〈5. 14) ， 通 过 球 来 定义 的 体积 ， 实 际 上 已 满足 这 
一 关系 。 
2. 概率 抽样 与 确定 性 抽样 
C 空间 的 抽样 可 分 为 概率 性 和 确定 性 两 种 。 无 论 
哪 种 方式 ， 通 党 需要 获得 一 个 样本 的 密集 序列 ae， 这 
意味 着 作为 样本 数 的 限定 值 趋 于 无 穷 大 时 ， 样 本 任意 
接近 C 中 的 点 。 对 于 概率 性 抽样 ， 这 个 密集 性 (以 概 
率 1) 确保 了 规划 算法 的 概率 完备 性 。 对 于 确定 性 抽 
样 ， 它 确保 了 分 辨 率 完 备 性 。 这 意味 着 如 果 人 解 存在 ， 
算法 要 保证 能 找到 它 ， 和 否则 算法 可 能 会 一 直 运 行 
下 去 。 
对 于 概率 抽样 ， 使 用 均匀 概率 密度 防 数 ， 在 C 上 
随机 选择 样本 。 要 通过 有 意图 的 方式 获得 均匀 性 ， 应 
该 采用 Haar 测度 ， 这 在 许多 情况 下 是 简单 直接 的 ， 
m SO(3) WER. BAH (HF Haar 测度 ) 
随机 四 元 素 可 通过 如 下 方式 选择 : 随机 地 选择 三 个 点 
we[0, 1] ， 且 令 $ 
h=( J1 -u sinru, V1 -ucos2mu, , 
[Ju Sin27us ， uicos27u, ) (5. 15) 
虽然 随机 样本 在 某 种 意义 上 是 均匀 的 ， 但 它们 也 
需要 有 一 些 不 规则 性 ， 以 满足 统计 检验 。 这 促进 了 确 
定性 抽样 方案 的 发 展 ， 以 提供 更 好 的 性 能 “" 。 取 
代 随 机 性 的 确定 性 抽样 技术 旨 在 优化 标准 ， 例 如 偏 关 
与 离 差 。 偏 差 使 采样 中 的 规律 性 恶化 ， 它 的 频繁 出 现 
会 给 数值 积分 带 来 麻烦 ， 离 差 给 出 了 最 大 空 球 (不 


li, Ln ， 
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含 样本 ) 的 半径 ,这 样 ， 离 差 快速 回落 表示 整个 空 
间 迅 速 搜索 。 确 定性 搜索 可 能 是 不 规则 的 邻 域 结构 
〈 出 现时 很 像 随 机 抽样 ) ， 或 者 为 规则 的 邻 域 结构 ， 
表示 点 党 网 格 或 格 点 排列 。 更 详细 的 运动 规划 相关 介 
绍 ， 参 见 参考 文献 [5.7]. 


5.6.3 代数 几何 计算 技术 


基于 抽样 的 算法 ， 具 有 和 良好 的 实用 性 ， 这 只 是 在 
付出 较 弱 完备 性 代价 下 就 实现 了 。 另 一 方面 ， 完 备 性 
算法 是 本 节 的 焦点 ,， 它 能 推断 出 规划 问题 的 无 解 
情况 。 

只 要 Cu 用 代数 表面 的 曲面 片 (patch) 来 表示 ， 
完备 性 算法 就 能 解决 几乎 所 有 的 运动 规划 问题 ， 从 
形式 上 讲 ， 该 模型 必须 是 半 代 数 的 ， 这 意味 着 它 由 
q 上 变 元 多 项 式 根 的 并 集 和 交集 组 成 ， 且 为 了 可 计 
算 性 ， 多 项 式 系数 必须 为 有 理 数 ( 否则 根 可 能 无 有 
限 表达 ) 。 具 有 有 理 系数 的 多 项 式 ， 其 所 有 根 的 集合 
称 为 实 代数 数 ， 它 具有 很 多 好 的 计算 性 能 。 关 于 实 代 
数 数 的 精确 表示 和 计算 ， 更 多 信息 见 参 考 文献 
[5. 12，102- 104 ] ， 对 于 代数 几何 的 介绍 见 参 考 文献 
[5.82], 

采用 基于 代数 几何 的 技术 ， 第 一 步 是 将 模型 转换 
成 为 所 需 的 多 项 式 。 假 如 模型 中 的 机 器 人 AAI RED 
GO 都 是 半 代 数 的 〈 这 包括 多 项 式 模型 ) ， 对 于 任何 附 
加 于 二 维和 三 维 构件 数 ， 运 动 变换 可 以 用 多 项 式 表 
示 。 由 于 多 项 式 变 换 后 ， 产 生 的 还 是 多 项 式 ， 故 变换 
后 的 机 器 人 模型 仍 为 多 项 式 。 通 过 仔细 考虑 所 有 的 接 
触 类 型 ， 计 算出 由 Cs 组 成 的 代数 表面 ， 这 里 机 器 人 
特征 (表面 、 边 线 、 顶 点 )， 要 与 障碍 物 特征 配 
WEEE 7915) ， 在 大 多 数 应 用 中 ， 这 一 步 往往 会 产生 过 
多 的 模型 图 元 。 

一 旦 得 到 了 半 代 数 表示 ， 就 能 使 用 来 自 代 数 几 何 
的 强力 技术 。 其 中 最 知名 的 算法 是 柱 形 代数 分 
fl> 02.106107] ， 它 提供 了 求解 运动 规划 问题 所 需 的 信 
息 。 此 方法 的 最 初 目 的 是 用 来 确定 是 备 Tarski sen- 
tences (它们 涉及 计量 和 多 项 式 ) 可 以 满足 并 找到 一 
个 不 涉及 计量 的 等 价 表达 式 。 柱 形 代 数 分 解 生成 的 单 
元 有 限 集 ， 其 中 多 项 式 的 符号 保持 不 变 。 这 种 方法 系 
统 地 实现 了 条 件 满足 和 计量 消除 ， 它 经 过 schwartz 和 
sharir" 验证， 可 用 于 求解 运动 规划 问题 。 

该 方法 概念 简单 ,但 在 技术 细节 上 还 有 许多 困 
难 。 称 为 柱 形 分 解 ， 是 因为 此 处 的 单元 都 构 织 成 垂 
直 的 立柱 单元 ， 其 二 维 例 子 如 图 5.18 所 示 。 如 图 
5.19 所 示 ， 有 两 种 类 型 的 临界 同 相 轴 ， 在 临界 点 上 
射线 东 朝 两 个 重 直 方向 无 限 延 长 。 这 里 的 分 解 不 同 


于 图 5.7 的 牌 直 分 解 ， 因 为 那里 的 射线 只 要 延伸 
至 找到 下 一 个 障碍 物 即 止 ， 而 这 里 是 为 了 获得 单 
元 柱 。 





图 5.18 立柱 单元 的 二 维 例 子 
a) 具有 四 个 图 元 的 人 脸 模 型 ”b) 脸 部 的 柱 形 代数 分 解 


ir 相交 


留 5.19 当 垂 直方 向 有 表面 折 登 或 者 表面 相交 时 ， 
就 会 出 现 临界 点 


fen BER, EPS EE CF) 表示 一 个 单元 链 ， 第 
一 个 和 最 后 一 个 单元 是 n 维 的 且 无 界 ， 剩 余 的 单元 是 
都 有 界 的 ， 并 在 ~1 维和 nn 维 间 交 蔡 。 有 界 n 维 单 
元 的 上 下 界 ， 由 单一 多 元 多 项 式 的 根来 确定 ， 这 使 得 
对 单元 及 其 连接 性 的 描述 变 得 简单 。 为 计算 这 样 的 单 
元 分 解 ， 算 法 需要 构建 一 个 投影 的 级 联 链 。 在 第 一 
P, Ch AR” 投影 到 RR"”， 接 下 来 投影 到 R"“， 这 
样 重 复 直 到 得 到 民 ， 它 为 带 有 一 个 单 变 量 的 多 项 式 ， 
并 在 所 有 临界 边界 设置 位 置 编码 ; 在 算法 的 第 二 阶 
段 ， 进 行 一 系列 的 提升 ， 每 次 提升 都 在 R' 上 获取 多 
项 式 和 单元 分 解 ， 并 将 其 通过 单元 柱 提升 到 RR'* 。 
单个 提升 的 示例 见 图 5. 18b。 整 个 算法 的 运行 时 间 ， 
取决 于 用 来 执行 代数 计算 的 具体 方法 。 总 的 运行 时 
间 ， 需 要 对 运动 规划 使 用 柱 形 代数 分 解 ， 边 界 为 
(md)? O", Hp m 为 描述 Cw 的 多 项 式 数 (一 个 大 
O, d 为 最 大 代数 次 数 。( 它 看 似 对 OC.) 为 奇数 ， 
并 出 现在 表达 式 的 中 间 。 在 本 文 情况 下 ， 它 表示 存在 
某 个 cs[0，om )， 使 运行 时 间 在 (md)”“ 上 有 界 ， 注 
意 整 个 公式 前 面 的 另外 一 个 0 并 非 必须 。) 需要 记 住 
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的 最 主要 一 点 是 ,算法 在 C 的 维 数 上 是 双 指 数 (甚至 
单元 数 也 是 双 指 数 ) 的 。 

虽然 执行 柱 形 分 解 对 于 解决 运动 规划 是 充分 的 ， 
但 与 必要 性 相 比 ， 它 计算 了 更 多 的 信息 ， 这 也 促使 了 
Canny 路 线 图 算法 的 出 现 “” 。 该 算法 直接 通过 半 代 
数 集 产 生路 线 图 ， 而 不 通过 沿路 构建 单元 分 解 ， 因 为 
在 柱 形 代 数 分 解 中 ， 有 许多 双 指 数 单元 ， 为 消除 这 种 
结构 需要 支付 代价 。 而 通过 Canny 路 线 图 方法 得 到 的 
结果 ， 在 时 间 上 求解 运动 规划 问题 时 ， 无 论 多 项 式 数 
还 是 多 项 式 代数 次 数 ， 都 还 是 一 个 多 项 式 ， 但 在 维 数 
上 仅 是 单 指数 的 7 。 

算法 的 基本 思想 是 ， 对 民 " HAC, PHAR? 
上 的 轮 廊 线 ， 即 通过 该 方法 找到 零 维 的 临界 点 和 一 维 
的 临界 曲线 。 临 界 曲 线 为 路 线 图 的 边线 ， 临界 点 为 
Cook (n-1) 维 的 曲面 片 ， 通 过 递归 算法 得 到 的 影 
像 点 ， 这 样 会 贡献 更 多 的 临界 点 和 临界 曲线 。 该 曲线 
被 添加 到 路 线 图 中 ， 算 法 再 次 在 临界 点 上 递归 ， 直 到 
递归 迭代 在 n =2 时 中 止 。Canny 的 结果 表明 ， 临 界 
曲线 的 合集 ， 保 护 了 Gu (并 因此 也 保护 了 Cre) 的 
连接 性 。 面 临 的 一 些 技术 问题 是 : DRIVE AMT Cw 的 
分 层 进入 流 形 起 作用 ; @ 算 法 具有 很 强 的 一 般 位 置 
假设 ， 以 至 于 很 难 满足 ; OHE PS ERI A Circe 
的 边界 来 考虑 的 ; @ 此 方法 不 能 产生 参数 化 的 求解 
BRIA, MF Canny 算法 及 其 他 重要 的 细节 改进 ， 见 
参考 文献 [5.102], 
5.7 结论 与 扩展 阅读 
我 们 在 本 章 简 要 纵览 了 运动 规划 问题 ， 这 是 一 个 
丰富 而 活跃 的 研究 领域 。 更 多 详情 ， 推 荐 两 本 新 书 供 
读者 参考 (参考 文献 [5.5, 7])， 也 可 以 查阅 一 些 
经 典 的 论文 和 书籍 (参考 文献 [5.4, 6])， 以 及 近 
来 的 研究 成 果 (参考 文献 [5.2，3]) ， 此 外 还 可 参 


考 本 章 罗 列 的 相关 手册 章节 。 
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6.1 运动 控制 简介 
本 章 将 回顾 机 械 辟 的 动力 学 模型 ， 并 着 重 强调 它 
在 控制 器 设计 中 一 些 非常 有 用 的 重要 性 质 ， 最 后 将 定 
义 机 械 臂 不同 的 控制 任务 。 


6.1.1 动力 学 模型 


对 于 运动 控制 ， 刚 性 机 械 臂 的 动力 学 模型 可 以 由 拉 
格 朗 日 动力 学 方程 简便 地 表示 出 来 。 设 机 械 臂 有 个 连 
杆 ， 关 节 变 量 的 (mn xl) 维 向 量 g 为 9=19，…， 
g,]'。 机 器 人 机 械 辟 的 动力 学 模型 可 由 拉 格 明日 方程 
FRELS 。 

H(q) q +C(q,q)q+te(q)=T (6.1) 
ste, H(q) 是 (nxn) 维 的 惯性 矩阵 ; C(9，&)29 
是 科 里 奥 利 力 和 离心 力 的 (n x1) SEB; Telg) 
是 重力 的 (n x1) 维 向 量 ; T 是 待 设计 的 关节 控制 
输入 的 (n x 1) 维 向 量 。 在 此 和 忽略 摩擦 和 扰动 
输入 。 

备注 : 

其 他 有 助 于 机 器 人 机 械 壁 动力 学 描述 的 方面 可 能 
还 有 驱动 器 动力 学 、 关 节 和 连 杆 邓 性 、 摩 擦 、 噪 声 和 
扰动 。 这 里 在 不 失 一 般 性 的 情况 下 ， 强 调 了 刚性 机 械 
臂 的 情况 。 

本 章 我 们 将 介绍 基于 一 些 机 器 人 机 械 臂 动力 学 模 
型 重要 性 质 的 控制 方案 。 在 详细 描述 各 种 不 同 的 控制 
方案 之 前 ， 我 们 先 列 出 这 些 性 质 。 

1， 性 质 6. 1 

惯性 矩阵 是 一 个 对 称 的 、 正 定 的 矩阵 ， 可 表 
示 为 : 

Af, <H(g) 过 和 人 HT。 
AP, A, Ml Ay 表示 正常 数 。 
2. 性 质 6.2 


ENC, 9) = H(qg) -2C(q, 4) 对 于 一 个 


特定 选取 的 C(q, g) (总 是 可 能 的 ) 是 反对 称 的 。 即 
对 于 任意 一 个 (n x1) HHE, zA: 


z'N(q, q)z=0 


(6.2) 


(6.3) 
3. 性 质 6.3 
对 于 某 个 特定 的 有 界 常数 c, (nxn) AEA 


IC(q, @) lise. lal 
4. 性 质 6.4 
对 于 一 个 特定 的 有 界 常数 go E/E H E 


(6.4) 
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满足 : 

ITC q) sg, (6.5) 
5, 性 质 6.5 
运动 方程 在 惯性 参数 中 都 是 线性 的 ， 即 有 一 个 


(rx1) 维 的 常数 向 量 & 和 一 个 (n xr) AHA 
阵 ¥Cq, q, q), 使 得 : 
H(q) 4 +C(q, 9)g +T:(4)=Y(4, q, q)a 
(6.6) 
AF, hie 是 由 连 杆 的 质量 、 惯 性 矩 和 连 杆 的 各 种 
组 合 组 成 的 。 
6. T+ im 6. 6 
Wit Tg 是 被 动 的 ; 亦 即 ， 存 在 a 宇 0， 使 得 
[FOTOS a, Ve<= 
备注 : 

1) 性 质 6.3 和 性 质 6.4 非常 有 用 ， 它 们 让 我 们 
可 以 确定 动力 学 模型 中 非 线 性 项 的 上 界 。 正 如 我 们 可 
以 进一步 看 到 的 ， 好 多 控制 方案 都 需要 这 些 关 于 上 办 
的 知识 。 

2) 在 性 质 6.5 中 ， 参 数 向 量 a 是 由 多 个 变量 的 
各 种 组 合 构成 的 。 该 参数 空间 的 维度 不 是 唯一 的 ， 在 
参数 空间 中 的 搜索 是 一 个 重要 的 问题 。 

3) 在 这 一 节 里 ,我 们 假设 机 械 辟 是 完全 驱动 
的 ,这 意味 着 对 于 每 个 自由 度 都 有 一 个 独立 控制 的 输 
入 。 相 反 ， 有 柔性 关节 或 者 柔性 连 杆 的 机 械 臂 不 再 是 
完全 驱动 的 ， 且 它们 的 控制 问题 一 般 而 言 会 更 加 
困难 。 


6.1.2 控制 任务 


出 于 比较 研究 的 目的 ， 将 控制 对 象 分 成 以 下 两 类 
是 有 益 的 : 

(1) 轨迹 跟踪 ”其 目的 是 在 一 定 的 工作 空间 内 
跟踪 关节 随时 间 变 化 的 参考 轨迹 。 一 般 而 言 ， 我 们 假 
设 期 望 的 轨迹 与 驱动 器 的 能 力 范围 一 致 。 亦 即 ， 与 期 
望 的 轨迹 有 关 的 关节 速度 与 加 速度 应 该 分 别 不 超过 其 
机 械 辟 的 速度 与 加 速度 的 极限 。 在 实际 情况 下 ， 驶 动 
器 的 能 力 是 由 转 矩 的 极限 决定 的 ， 这 使 得 复杂 且 状 态 
相关 的 加 速度 是 有 界 的 。 

(2) 调节 有 时 也 叫 点 对 点 控制 。 首 先 在 天 下 
空间 里 指定 一 个 固定 的 参数 设置 ， 目 标 是 使 关节 的 变 
量 能 保持 在 期 望 的 位 置 ， 不 受 转 矩 扰动 的 影响 而 独立 
于 初始 状态 。 一 般 而 言 瞬 态 和 超 调 行为 都 是 无 法 确 
定 的 。 

控制 器 的 选择 依赖 于 所 要 执行 的 控制 任务 的 





(6.7) 
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类 型 。 例 如 ， 只 需要 机 械 辟 从 一 个 位 置 移动 到 另 
外 一 个 位 置 而 对 这 两 点 间 的 运动 过 程 的 精度 没有 
特别 高 的 要 求 的 控制 任务 可 以 由 调节 来 完成 ,而 
在 一 些 其 他 的 任务 中 ， 如 焊接 、 喷 漆 等 则 需要 跟 
踪 控 制 。 

备注 : 

1) 调节 问题 是 跟踪 问题 的 一 个 特例 〈 期 望 的 关 
人 速度 和 加 速度 都 为 零 ) 。 

2) 在 关节 空间 中 给 出 以 上 的 任务 说 明 ， 就 出 现 
了 关 市 空间 控制 。 这 是 本 章 的 主要 内 容 。 有 时 ， 以 末 
跨 执 行 器 的 期 望 轨 迹 所 做 的 机 器 人 机 械 辟 的 任务 说 明 
(如 手眼 控制 ) 是 在 任务 空间 进行 的 ， 并 引起 操作 空 
间 的 控制 ， 这 将 在 6. 2 节 介 绍 。 


6. 1.3 小 结 


在 这 一 节 ， 我 们 介绍 了 机 器 人 机 械 辟 的 动力 学 模 
型 及 其 重要 性 质 ， 而 且 定义 了 机 器 人 机 械 臂 不 同 的 控 
制 任务 。 


6.2 关节 空间 与 操作 空间 控制 
在 运动 控制 问题 中 ,机械 辟 移动 到 一 个 位 置 拿 到 
一 个 物体 ， 将 其 运送 到 另 一 个 位 置 并 放下 它 ， 这 样 一 
个 任务 是 任何 一 个 更 高 级 别 操作 任务 如 喷漆 或 点 焊 的 
一 部 分 。 

任务 通常 是 以 在 任务 空间 上 末端 执行 器 期 望 的 轨 
迹 来 指定 的 ， 而 控制 操作 是 在 关节 空间 进行 的 ， 以 达 
到 期 望 的 目标 。 这 一 事实 自然 而 然 地 引出 了 两 种 一 般 
的 控制 方法 ， 即 关节 空间 控制 和 操作 空间 控制 E 
务 空间 控制 ) 。 


6.2.1 关节 空间 控制 


关节 空间 控制 的 主要 目标 是 设计 一 种 反馈 控制 
器 ， 它 使 关节 坐标 系 q(t) e R” 尽 可 能 精确 地 跟踪 期 
望 运动 qs(1)。 为 此 ， 考 虚 关 节 空 间 *? 人 中 一 个 n 个 
自由 度 机 械 辟 的 运动 方程 式 (6. 1)。 在 这 种 情况 下 ， 
机 器 人 机 械 臂 的 控制 很 自然 地 在 关节 空间 中 得 到 ， 因 
为 控制 输入 就 是 关节 的 转 朱 。 尽 管 如 些 ， 当 使 用 者 以 
末端 执行 器 坐标 系 定义 一 个 运动 时 ， 仍 有 必要 了 解 以 
下 方法 。 

图 6. 1 所 示 为 关节 空间 控制 方法 的 略图 。 首 先 ， 
通过 末端 执行 器 坐标 系 描述 的 期 望 运动 被 转化 为 对 
应 的 关节 运动 轨迹 ， 这 一 过 程 是 通过 运用 机 械 壁 的 
闭 运 动 学 方程 实现 的 。 然 后 ， 反 馈 控 制 顺 通过 测量 
机 械 辟 当前 的 关节 状态 ， 会 确定 需要 的 关节 转 矩 大 


小 ， 使 机 械 臂 沿 着 关节 坐标 系 中 定义 的 期 望 轨迹 移 
动 [6.1,4,7,8] , 


图 6.1 关节 空间 控制 的 广义 概念 


由 于 通常 都 会 假定 期 望 的 任务 是 按 关节 运 动 的 时 
间 顺 序 给 出 的 ， 所 以 关节 空间 控制 方案 在 机 械 辟 任务 
精确 计划 过 ， 并 且 很 少 或 者 不 需要 进行 在 线 轨 迹 调 整 
的 情况 下 就 足够 了 “ …。 典 型 地 ， 道 运动 学 被 应 
用 于 计算 一 些 中 间 任 务 点 ， 并 且 关 节 的 运动 轨迹 可 以 
进行 中 间 捅 补 。 尽 管 指 令 轨 迹 是 在 末端 执行 器 坐标 系 
插入 点 之 间 的 直线 运动 ， 但 最 终 的 关节 运动 轨迹 是 由 
插入 点 中 符合 期 望 的 末端 执行 器 运动 轨迹 的 曲线 部 分 
组 成 。 

实际 上 ， 关节 空间 控制 包括 简单 的 PD 控制 、 
PID 控制 、 首 动力 学 控制 、 李 雅 普 诺 夫 控 制 和 被 动 控 
制 。 这 些 控制 方案 都 将 在 下 文中 进行 介绍 。 


6.2.2 操作 空间 控制 


在 更 加 复杂 和 确定 性 较 小 的 环境 中 ,末端 执 行 
器 的 运动 会 服从 在 线 修 正 以 适应 不 可 预期 的 情况 出 
现 或 是 对 传感器 输入 进行 啊 应 。 这 类 控制 问题 存在 
于 生产 制造 过 程 的 各 种 任务 中 。 尤 其 是 当 需 要 考虑 
机 械 臂 与 工作 环境 的 交互 作用 时 ， 这 类 情况 都 会 
出 现 。 
由 于 期 望 任 务 通常 会 在 操作 空间 中 定义 ， 并 且 需 
要 对 末端 执行 器 的 运动 进行 精确 控制 ， 所 以 关节 空间 
控制 在 上 述 情 况 下 并 不 合适 。 这 就 产生 了 一 种 新 方 
法 ， 它 可 以 直接 根据 操作 空间 中 表示 的 动力 学 给 出 控 
制 方案 。 
BRER EEREN Jq) eR", RER (6.8) 将 
关节 速度 (q eR) 转化 为 任务 速度 (x eR"). 
x =J(q)q (6.8) 
FFA, 假设 它 是 可 逆 的 。 那 么 ,操作 空间 的 动力 学 就 
可 由 下 式 表 示 : 
f.=A(q) x +T(g,g)x +n(gqg) (6.9) 
AP, f, eR 是 操作 空间 的 指令 力 ， 伪 惯性 矩阵 由 下 
式 定 义 : 
A(q) =J (Hg) J (q) 
并 且 T(qg,， 4) Mnl) 由 下 式 给 出 : 
T(q,g)=J (gq)C(g,g)T (gqg) -ADODI (a) 


(6. 10) 
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n(q) =J" (gq)Te(g) 
任务 空间 变量 通常 由 关节 空间 变量 通过 运动 学 映 
射 重 建 。 事 实 上 ， 我 们 很 少 使 用 传感器 直接 测量 末端 
执行 器 的 位 置 与 速度 。 同 时 值得 注意 的 是 ， 因 为 控制 
方案 直接 作用 于 任务 空间 量 ， 如 末端 执行 器 的 位 姿 ， 
此 处 通常 会 使 用 一 个 分 析 雅 可 比 短 阵 。 
操作 空间 控制 的 主要 目标 是 设计 一 种 反馈 控制 
a, EOLA ARTA tT aia oi x(t) eR’, ie 
动 会 尽 可 能 准确 地 跟踪 期 望 的 末端 执行 器 运动 x4 (1) o 
为 此 ， 考 察 操作 空间 下 给 出 的 机 械 臂 运动 方程 
(6.9) 。 对 于 这 种 情况 ， 图 6. 2 给 出 了 操作 空间 控制 
方法 的 示意 图 。 该 方法 有 不 少 优点 ， 因 为 操作 空间 控 
制 器 采用 了 一 个 反馈 控制 闭环 ， 可 以 直接 最 大 限度 地 
减 小 任务 误差 。 由 于 控制 算法 舱 入 了 速度 级 的 正 运动 
学 式 (6.8)， 因 此 不 需要 精确 的 逆 运 动 学 计算 。 这 
样 ， 点 与 点 之 间 的 运动 就 可 以 表示 为 任务 空间 的 直线 
线段 。 


9am H 


图 6.2 操作 空间 控制 的 基本 概念 


6.3 ”独立 天 下 控制 


独立 关节 控制 (如 ,分 散 控制 ) AAT AR 
的 控制 输入 只 取决 于 相应 的 关节 位 移 与 速度 大 小 的 控 
制 方式 。 由 于 它 的 简单 结构 ， 这 种 控制 方式 具有 许多 
优点 。 例 如 ， 通 过 独立 关节 控制 ， 可 以 省 去 各 个 关节 
之 间 的 联系 。 此 外 ， 因 为 控制 器 的 计算 量 可 以 减 小 ， 
所 以 在 实际 应 用 中 低 成 本 的 硬件 就 可 以 满足 要 求 。 由 
于 所 有 关节 的 控制 器 都 有 相同 的 构成 ， 因 而 独立 关节 
控制 具有 可 扩展 的 特点 。 本 节 将 介绍 两 种 独立 着 控 
制 方法 : 一 种 着 眼 于 各 关节 的 运动 学 模型 《如 ， 单 
关节 模型 ) 的 分 析 ， 另 一 种 着 眼 于 整体 运动 学 模型 
(如 ， 多 关节 模型 ) 的 分 析 。 


基于 单 关 节 模 型 的 控制 器 设计 


最 简单 的 单一 关节 控制 策略 就 是 将 每 个 关节 和 轴 
作为 单 人 单 出 (SISO) RK. APR PS 
中 不 同 设置 所 产生 的 关节 之 间 的 耦合 效应 可 以 被 视 
为 扰动 输入 。 不 失 一 般 性 ， 将 驱动 器 看 作 是 直流 旋 
转 电动 机 。 因 此 ， 关 节 纪 的 控制 方案 的 框图 可 在 复 
变 函 数 域 中 表示 ， 如 图 6.3 所 示 。 在 这 种 控制 方案 


6. 3.1 
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中 ,9 表示 电动 机 的 角 变 量 ,，J 表示 从 电动 机 来 看 的 
ARRE, R, 是 电 枢 电阻 (REAR), k Ak, 分 
别 表 示 转 惩 与 电动 机 常数 。 此 外 ，C, 表示 功率 放大 
句 的 电压 增益 ， 这 样 就 确定 了 参考 输入 是 放大 器 输 
ABETE V, 而 不 是 电 枢 电压 VY,。 也 可 以 假定 Fa << 
kyk./R,, BURL (BAPE) 摩擦 系数 与 电 系 数 相 比 可 
以 和 忽略。 现在， 电动 机 的 输入 -输出 传递 函数 可 由 下 
式 表示 : 





Mo a 
s) ss(1+sT,) 
RP, ky = Gy 有 AIT, =R J/k k, 分 别 表示 电压 - 束 


度 增益 及 电动 机 的 时 间 常 数 。 


(6. 11) 





图 6.3 关节 驱动 系统 框图 〈 来自 参 考 文献 [6.4」 ) 


要 帮助 控制 结构 的 选取 ， 首 先 要 注意 与 输出 角 8 
有 关 的 有 效 抑制 扰动 d 由 以 下 两 点 确定 : 

1) 扰动 的 播 补 点 前 有 大 的 放大 恬 值 。 

2) 控制 器 中 积分 作用 的 存在 ， 用 以 消除 稳定 状 
态 时 输出 的 重力 分 量 效应 ( 如， 常数 9) 。 

这 种 情况 如 图 6.4 所 示 ， 具 有 位 置 和 速度 反 锯 的 
控制 操作 类 型 由 图 6. 4 来 表示 。 


G(s) =Kp, G,(s) =Ky 


l +sT 
一 (6. 12) 


AP, G(s) AG (s) PHHAATASRE NE 
制 操 作 。 值 得 注意 的 是 ， 内 部 控制 操作 C(s) 是 比 
例 积分 (Pl) 控制 的 一 种 形式 ， 它 是 定 值 扰动 为 d 
时 稳 状 态 中 的 零 误 差 。 此 外 ，pr 和 kry AE 1E RAF 
常数 ， 并 且 放 大 器 增益 Ky BRA WA BB Fe hil ab 
增益 。 

在 图 6.4 中 ， 前 向 路 径 和 返回 路 径 的 传递 函数 分 
别 为 式 (6.13) M (6.14): 
天 天 ,天 (1 +sTy ) 


PCs) =- Gas) 


(6. 13) 


(6. 14) 





_ kry 
H(s) = ke (1 +5 Rh) 


在 s= -1/Ty 时 ， 可 以 选择 控制 器 的 零点 以 消除 
在 s= -1/T, 时 电动 机 真正 电极 的 影响 。 然 后 , 令 
Ty = 7, ， 则 在 根 轨 迹 上 移动 的 闭环 系统 的 极点 可 以 
作为 闭环 增益 的 函数 khykry。 通 过 增加 反馈 增益 
K,， 可 以 将 闭环 的 极点 限制 在 一 个 有 大 的 绝对 值 实 部 
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图 6.4 位 置 与 速度 反馈 框图 ( 来 自 参考 文献 [6.4] ) 


的 复 平 面 域内 。 这 样 ， 通 过 选择 适当 的 Ky 就 可 以 确 
定 实际 位 置 。 
闭环 输入 输出 传递 函数 为 
] 


OCs) _ krp 
O, (s) E Shipp s? (6. 15) 


Keke k K,kaeK, 
JE KAJ- HE EY Fy — YY R AE E BRIA EE 
1 


krp 
2 
1 + 
Wa 


a 








W(s) = (6. 16) 


可 以 看 出 ， 通 过 选择 适当 的 增益 ， 可 以 得 到 任何 
自然 频率 值 o MBEE co A, WRA H o, AC 
作为 设计 规格 参数 ， 就 可 以 得 到 如 下 关系 

260, w, 
Ky kry Tk KpkypKy Ek 

对 于 给 定 的 传感器 常数 所 ,和 kr,， 可 以 分 别 得 到 
满足 式 (6.16) 和 式 (6.17) 的 K,， 和 K。。 另 一 方 
面 ， 闭 环 扰动 /输出 的 函数 为 

sR, 
O(s) _ &,.KpKypKy (1 +sT, ) 
D(s) | + skry + s° (6. 18) 
Kokr kr KphypKy 

TR PRN Ze AA He oh a al A Xr (s) = Kpkrp Ky, 
并 且 是 固定 的 。 关 于 扰动 动力 学 ， 应 该 牢记 由 PI 产 
生 的 原点 处 的 零 值 、 在 s = -1/7 处 的 真正 极点 ， 以 
及 实 部 为 -tn BOSE PER BR. FERAL FE, 
使 控制 系统 从 关节 位 置 的 扰动 作用 中 恢复 所 需 的 输出 
恢复 时 间 的 估计 值 Te 就 可 以 通过 分 析 上 述 传递 函数 
的 模型 得 出 。 这 一 估计 值 可 以 相应 地 表示 为 Ta = 
max} Ta, l/tw|。 


6.3.2 基于 多 关节 模型 的 控制 器 设计 
近年 来 ， 人 们 已 经 提出 了 许多 基于 机 械 辟 整体 


(6.17) 








运动 学 模型 的 独立 关节 控制 方案 (多 关节 模型 )。 
例如 ， 计 算 转 矩 类 控制 方法 ， 参 考 文献 [6.12] 中 
处 理 水 平 运动 的 调节 任务 ， 参 考 文献 [6.13] 和 
[6.14] 中 处 理 任 意 平 滑 轨迹 的 跟踪 任务 。 因 为 考 
察 的 是 整体 运动 学 模型 ， 所 以 需要 处 理 关 节 之 间 
的 耦合 作用 。 这 样 的 控制 方案 将 在 6.6 节 中 详细 
介绍 。 


6.3.3 小 结 和 扩展 阅读 


在 本 节 中 ， 我们 已 经 提出 了 两 个 独立 的 关节 控 
制 方案 : 一 个 基于 单 关节 模型 ， 另 一 个 基于 多 关节 
模型 。 前 者 侧重 于 单一 关节 的 动力 学 以 及 关节 之 间 
相互 作用 产生 的 扰动 。 这 种 控制 方案 简单 ， 但 可 能 
不 适合 高 速 跟踪 。 因 此 ， 我们 介绍 了 后 者 ， 考 虑 了 
机 器 人 机 械 臂 的 整体 动力 学 模型 来 处 理 关 节 中 间 的 
相互 作用 。 

基于 单 关节 模型 的 独立 关节 控制 中 应 用 了 许多 不 
同 的 反馈 类 型 (如 纯 位 置 反 馈 或 位 置 、 速 度 和 加 速 
BERR). Be [6.4] 给 出 了 完整 的 讨论 。 当 
我 们 需要 关节 控制 伺服 来 以 高 速 和 加 速度 跟踪 参考 轨 
迹 时 ， 上 述 方案 的 跟踪 性 能 不 可 避免 地 会 递减 。 一 种 
可 能 的 补救 办 法 是 采用 分 散 前 馈 补 偿 来 降低 跟踪 
FRR ， 


6.4 PID 控制 


传统 上 ， 机 器 人 机 械 臂 的 控制 方案 可 以 被 理解 为 
每 个 电动 机 驱动 机 械 臂 关节 级 的 PD 或 PID 补偿 器 参 
数 整定 二 这样 一 个 简单 的 事实 : 基本 上 ， 当 PD 控 
制 器 应 用 于 双 积 分 器 系统 时 ， 它 是 一 个 具有 良好 闭 
环 性 能 的 位 置 与 速度 反馈 控制 器 。 自 齐 格 勒 - 尼 柯 尔 
斯 的 PID 整定 规则 于 1942 年 出 版 后 “2 ，PID 控制 
就 有 了 悠久 的 历史 。 实 际 上 ，PID 的 控制 优势 在 于 
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其 简单 性 和 有 明确 的 物理 意义 。 至 少 在 工业 上 ， 如 
果 通 过 复杂 控制 获得 性 能 提高 是 十 分 不 够 的 ， 那 么 
简单 的 控制 则 优 于 复杂 的 控制 。PID 控制 的 物理 意 
SUS UTR ; P- 控 制 是 指 由 当前 状态 到 期 望 状态 的 
当前 的 作用 ; 工控 制 是 指 以 往 状 态 经 验 信息 的 累积 
作用 ; D- 控 制 是 指 反映 未 来 状态 的 趋势 信息 的 预 其 
作用 。 


6.4.1 调节 的 PD 控制 


机 械 臂 控制 的 一 个 简单 设计 方法 是 相对 于 一 个 
操作 点 的 、 利 用 基于 系统 线性 化 的 线性 控制 方案 。 
此 方法 的 一 个 例子 是 一 种 具有 重力 补偿 方案 的 PD 
控制 “ …” 。 重 力 补 偿 是 一 种 偏差 纠正 ， 仅 对 引起 
超 调 和 非 对 称 瞬 态 行 为 的 力 进行 补偿 。 它 具有 以 下 
形式 

T=K,(q,-@) -Kvgq +T:.(q) (6. 19) 

AH, Kp Al Ky eR" Fee eS AR. AP EE il aE 

对 于 设 定点 调节 是 非常 有 用 的 , 例如 ，gs Æ H 

BETS) 。 采 用 此 控制 器 时 ( 见 式 (6.1)), 闭环 方 
程 则 变 成 

H(q) 9 +C(q,9)q+K,yq-K,e,=0 (6.20) 


Rp, e =g -9g, FERE y lel, gl =0。 现 
在 ， 由 带 重力 补偿 的 PD 控制 得 到 的 稳定 性 可 根据 闭 
环 动力 学 进行 分 析 (6.20) 。 考 虑 正定 函数 


1 .。， . 1 
= 4 'H(q)q +7 ea Kye, 


然后 ， 通 过 使 用 6. 1 节 中 的 性 质 6.2， 对 g 的 任意 
fi, PR SPCR ee ae YB 

V = -4KS -A (Ky) lligi (6.21) 
EP, A_,,(Ky) 是 天 ,的 最 小 特征 值 。 通 过 引用 李 雅 
普 诺 夫 (Lyapunov) 稳定 性 理论 和 拉 院 尔 〈Lasalle ) 
定理 ' | ， 可 以 看 到 ， 调节 误差 将 逐渐 收 钱 为 等 ， 
而 其 高 阶 导 数 保持 有 界 。 尽 管 比较 简单 ， 但 是 这 
种 控制 器 需要 重力 分 量 (结构 和 参数 ) 方面 的 
知识 。 


现在 ， 考 虑 简单 的 无 重力 补偿 的 PD 控制 


T=K (qa -4)-Kyq (6. 22) 
则 闭环 动力 学 方程 变 成 
H(q) d +C(q,g)q+Te(q) +Kyq - Koes =0 
(6.23) 
考虑 正定 函数 


l. . 1 
= 4 H(g)g + 7 eKves +U(g) + Uo 


AP, Ulga) 是 3U(9g)/9g =Te(q) 的 势能 ; 是 一 
个 合适 的 常数 。 了 了 的 时 间 导 数 和 闭环 动力 学 方程 
(6.23) 给 出 了 与 之 前 利用 重力 补偿 相同 的 结果 式 
(6.21)。 在 这 种 情况 下 ， 控制 系 统 必 须 在 李 雅 普 诺 
夫 意 义 上 是 稳定 的 ,但 它 不 能 得 出 根据 拉 院 尔 定 
理 “ "| ， 调 节 误 差 将 收敛 到 零 的 结论 。 实 际 上 ， 该 系 
统 精度 (调节 误差 向 量 的 大 小 ) 将 取决 于 下 面 公式 
中 增益 矩阵 Kb 的 大 小 。 

lle, ls Ky" Ilgo (6. 24) 
式 中 ，g 在 6.1 节 的 性 质 6.4 中 。 因 此 ， 调节 误差 可 
以 通过 增加 K, 而 任意 减少 ;然而 ,测量 噪声 和 其 他 
未 建 模 的 动力 学 因素 ， 例 如 驱动 絮 摩 擦 ， 将 限制 高 增 
益 在 实际 中 的 使 用 。 


6.4.2 调节 的 PID 控制 


为 了 处 理 重 力 问题 ， 我 们 将 在 之 前 的 PD 控制 中 
增加 一 种 积分 作用 ， 在 某 种 程度 上 ， 这 可 以 看 作 是 常 
值 扰动 (从 局 部 观点 看 ) o PID 调节 控制 右 可 以 写成 
以 下 一 般 形式 


T = Ke(qgs -4) + Kif fga - 9) dt - Kya 
ath, Ke RUS EEE, HE, # 
Ka-4) =g -g， 我 们 有 PID 控制 ; A K f- 4)dt 


增加 ， 我 们 有 PED 控制 ; Ae fC +) =tanh(-), Ri] 
有 PD + 非 线性 积分 控制 。 

对 于 含有 外 绕 的 机 器 人 运动 控制 系统 ， 如 库仑 摩 
E, PID 控制 的 全 局 渐 近 稳定 性 (GAS) 已 在 参考 文 
HK [6.12] 中 证 明 。 (Tomei) 在 参考 文献 [6.19 ] 
中 也 通过 对 重力 项 的 自 适 应 证 明了 PD 控制 的 全 局 渐 
近 稳 定性 。 另 一 方面 ， (Ortega) 等 人 在 参考 文献 
[6.20] PXH, PED 控制 在 存在 重力 和 有 限 外 绕 时 
可 能 会 产生 半 全 局 渐 近 稳定 性 (SGAS). 

另外 ， 在 参考 文献 [6.21] F, (Angeli) 证 明 
PD 控制 对 于 机 器 人 系统 可 以 实现 输入 -输出 对 状态 稳 
E (I0SS )。 此 外 ，(Ramirez) 等 人 在 参考 文献 
[6. 22] 中 证 明了 PID 增益 〈 某 些 条 件 下 ) 的 半 全 局 
渐 近 稳定 性 。 此 外 ，(Kelly) 在 参考 文献 [6.23] 中 
证 明了 PD 加 非 线 性 积分 控制 可 以 实现 在 重力 下 
的 GAS。 

事实 上 ，PID 控制 中 的 一 个 大 的 积分 作用 会 造成 
运动 控制 系统 的 不 稳定 。 为 了 避免 这 种 情况 ， 积 分 增 
益 应 该 是 以 下 式 为 上 限 的 于 ”… : 
kpky 
> 
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式 中 Aa 是 6.1 节 的 性 质 6.1 中 的 ; Kp =k, K = 天 了 
AIK, =ky1。 这 一 关系 为 增益 的 选择 提供 了 隐 含 的 指 
So Ub, PID 控制 产生 了 大 量 的 PID 控制 附属 物 。 
例如 ，PID 附加 摩擦 补偿 器 ，PID 附加 重力 补偿 器 ， 
PID 附加 扰动 观测 器 。 


6.4.3 PID 增益 整定 


PID 控制 可 用 十 轨迹 跟踪 和 设 定点 调节 。 真 正 的 
跟踪 控制 在 6.5 节 后 介绍 。 在 本 节 中 ， 将 介绍 实际 使 
用 中 简单 是 有 用 的 PID 增益 整定 方法 。 一 般 PID 控制 
髓 可 以 被 写成 下 面 一 般 的 形式 : 


T = Kye, + K;e, +K, fe,di 
或 男 一 种 形式 : 


T = (x +31) (è, + Kves + Kfesdt) (6.25) 


在 一 个 跟踪 控制 系统 的 基本 稳定 性 分 析 中 ， 
Qu 等 人 在 参考 文献 [6.24] 中 证 明 PD 控制 可 以 满 
足 一 致 最 终 有 界 性 (UUB)。 此 外 ,在 参考 文献 
[6.25] 中 ，Berghuis 等 人 提出 输出 反馈 PD 控制 ， 该 
控制 方法 在 重力 和 有 界 扰动 下 满足 半 全 局 一 致 最 终 有 
界 性 (SGUUB)。 最 近 ，choi 等 人 提出 了 逆 优 化 PID 
控制 方法 “” ， 它 确保 了 扩展 扰动 的 输入 - 状态 稳定 
fe (ISS), 

实际 上 ， 如 果 PID 控制 器 式 (6.25) 被 反复 应 
用 到 同一 设 定点 或 期 望 轨迹 ， 那 么 ， 最 大 误差 将 与 下 
式 中 的 增益 成 比例 关系 : 


max |le, (£) Ilo —— 
CEE J2ky +1 
式 中 ,tt 指 给 定 任务 的 最 终 执 行 时 间 ， HE K =k, 
这 种 关系 可 以 用 来 调整 一 个 PID 控制 器 的 增益 ， 被 称 
为 复合 整定 规则 “'"” 。 复 合 整 定 规则 暗含 如 下 简单 的 
调整 规则 ; 
平方 整定 : 对 于 一 个 小 的 下 ，max|e lly’, 
线性 整定 : 对 于 一 个 大 的 k，max||e, leyo 
例如 ,假设 我 们 选取 正 的 常数 对 角 和 矩阵 Kp = 
kpl, K =k, 且 满 足 ks >2k,. 对 于 小 的 值 ， 根 据 
平方 整定 规则 ， 如 果 我 们 减少 y 为 /2， 最 大 误差 将 
减少 1/4。 对 于 大 的 上 值 ， 根 据 线 性 整定 规则 ， 最 大 
误差 将 会 成 比例 地 随 春 y 而 减少 。 这 意味 着 当 其 他 增 
益 参 数 被 确定 后 ， 我 们 可 以 仅仅 使 用 一 个 变量 y 来 调 
$ PID 控制 器 ““ 。 尽 管 这 些 规则 对 调整 控制 性 能 是 
非常 有 用 的 ， 但 是 它们 仅 能 够 使 用 于 相同 点 设 定 或 期 
望 轨迹 的 重复 实验 中 ， 因 为 调节 规则 由 比例 关系 


(6. 26) 


构成。 
6.4.4 扩展 阅读 


PID 类 型 的 控制 器 是 为 了 解决 调节 控制 问题 而 设 
计 出 来 的 。 这 些 控制 方法 的 优点 是 无 须知 道 模型 结构 
或 模型 参数 。 此 外 ， 本 节 介 绍 了 PID 类 型 的 控制 器 所 
实现 的 稳定 性 。 读 者 可 以 找到 很 多 详细 介绍 PID 控制 
中 的 各 种 调节 方法 及 其 具体 证 明 的 书籍 和 
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6.5 跟踪 控制 


独立 的 PID 控制 对 多 数 设 定 点 调节 问题 来 说 是 
足够 了 ， 但 是 还 有 许多 任务 需要 有 效 的 轨迹 跟踪 能 
力 ， 比 如 ， 等 离子 焊接 、 激 光 切 割 或 者 存在 障碍 物 
情况 下 的 高 速 操作 等 。 这 些 情 况 中 ， 运 用 局 部 方案 
需要 在 大 量 中间 设 定点 中 慢 速 移动 ， 所 以 大 大 延迟 
了 任务 的 完成 。 因 此 为 了 改善 轨迹 跟踪 的 效果 性 能 ， 
控制 器 应 该 考虑 计算 转 矩 类 技术 的 机 械 臂 的 动态 
模型 。 

在 关 刷 或 任务 空间 中 的 跟踪 控制 问题 包括 给 定 的 
时 变 轨迹 gG) 或 者 y(t), ENTRIES qalt) 


R xa), UR da) Mx y(t), 这 些 参数 分 
别 描述 的 是 期 望 的 速度 和 加 速度 。 为 了 得 到 好 的 
PEGE, DoS Hy Ae Fe RE A 1 7]。 
在 文献 所 报道 的 控制 方法 中 ， 典 型 方法 包括 道 动 
力学 控制 、 反 馈线 性 化 技术 和 基于 被 动 性 的 控制 
方法 。 
6.5.1 六 动力 学 控制 
尽管 逆 动 力学 控制 有 理论 上 的 背景 ， 如 后 面 
讨论 的 反馈 线性 化 技术 ,但 是 它 的 起 点 是 基于 消 
除非 线性 项 和 人 解 看 每 个 连 杆 动力 学 的 机 械 工程 上 
的 直觉 。 在 关节 空间 中 的 道 动力 学 控制 有 如 下 
公式 : 
T=H(q)v +C(q,q)q+%(q) (6.27) 
将 式 代 人 到 式 (6.1) 中 ,会 得 出 = 个 解 看 的 线性 
系统 方程 组 ， 例 如 了 =v, 其 中 v 是 一 个 待 设 计 
的 辅助 控制 输入 变量 。* 的 典型 选择 是 
v= 44+ Ky(4aa- q) + K,(q@,-@) (6. 28) 
或 带 有 积分 分 量 
v = ga + Kyla -9) + Kp(qs -@) +K [Cga -qd 
(6.29) 
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推导 得 到 对 于 辅助 控制 的 输入 式 (6.28) 的 误差 动 
力学 方程 
e,+K,e, +K,e, =0 
如 果 使 用 了 辅助 控制 输入 式 (6. 29) ， 误 差 动 力学 方 
程 则 为 
e +K, e,+Kpe,+Ke,=0 | 

通过 选择 合适 的 增益 矩阵 K, K, (和 天 ) ， 两 者 的 误 
差 动力 学 方程 都 是 呈 指 数 级 稳定 的 。 

或 者 ， 道 动力 学 控制 可 以 在 操作 空间 中 描述 。 考 
虑 操作 空间 动力 学 式 (6.9)， 如 果 在 操作 空间 中 采 
用 下 面 的 逆 动 力学 控制 


f.=A(q)(x4+Kyé,+K,e,) +T(q,q)x +n(g) 
ste, =x, ~x， 则 产生 的 误差 动力 学 方程 为 

e,+K,e, +K,e, =0 (6. 30) 
它 也 是 呈 指 数 稳 定 的 。 采 用 这 种 控制 器 的 一 个 明显 优 
点 是 可 以 选择 在 操作 空间 中 有 清晰 物理 意义 的 K, 和 
K,。 但 是 ， 如 式 (6.10) 所 见 ， 机 器 人 接近 奇异 位 
Ent, Ala) 值 会 变 得 很 大 。 这 意味 着 为 了 移动 机 械 
臂 ， 在 某 个 方向 上 需要 很 大 的 力 。 


6.5.2 反馈 线性 化 


这 种 方法 是 刚性 机 械 辟 道 动 力学 概念 的 广义 化 。 
反馈 线性 化 的 基本 思想 是 构造 一 个 所 谓 的 内 环 控制 
的 变换 ， 它 使 非 线 性 系统 在 坐标 进行 了 合适 的 状态 
空间 变化 后 能 精确 地 线性 化 。 这 样 ， 设 计 者 就 能 在 
新 的 坐标 系 中 设计 出 第 二 级 或 外 环 控制 以 满足 传统 
控制 方案 要 求 ， 如 轨迹 跟踪 、 抗 扰动 等 “*” 。 如 果 
设计 者 在 机 械 臂 的 动力 学 描述 中 包括 了 传动 动力 学 ， 
例如 轴 弯 曲 引 起 的 弹力 ,齿轮 弹力 等 ,那么 ,机械 
辟 控 制 的 反馈 线性 化 方案 的 整个 力量 就 变 得 显 而 多 
见 了 。 

近 几 年 来 出 现 了 大 量 令 人 印象 深刻 的 关于 非 线 性 
系统 微分 几何 方法 的 文献 。 此 领域 的 大 多 数 绩 采 目 的 
是 给 出 非 线 性 系统 各 种 几何 性 质 的 与 坐标 无 关 的 抽象 
描述 ， 但 这 对 非 数 学 家 来 说 很 难 理解 。 本 记 的 目的 是 
给 出 反馈 线性 化 方案 的 基本 思想 ， 并 介绍 这 项 技术 的 
一 个 简单 版 本 ， 以 找到 机 械 臂 控制 问题 的 直接 应 用 。 
读者 可 参考 文献 [6.30], ， 了 解 采 用 微分 几何 方法 的 
反馈 线性 化 技术 的 综合 法 。 

现在 考虑 一 般 的 输出 志 E RR， 找 到 一 个 简单 方法 
来 确定 机 械 臂 动力 学 方程 (6.1) 的 线性 化 状态 空间 
表述 ; 

é=h(q) +r(t) (6. 31) 
R, Alq) 是 关节 坐标 ge R" 的 一 个 一 般 的 预定 函 


数 ， 而 且 r(t) 是 一 般 的 预定 时 间 隆 数 。 控 制 目 标 将 
是 选择 关节 转 从 输 入 T 值 使 输出 &(1) 变 为 零 。 

h(g) 和 r(t) 的 选择 是 基于 控制 目标 的 。 例 如 ， 
如 果 我 们 和 希望 机 械 臂 跟踪 的 期 望 关节 空间 的 轨迹 满足 
h(q)=-q, 并 且 r(t) =g), IA EG) =qa(t) - 
q(t) 三 e,(1) 则 为 关 厂 空间 的 跟踪 误差 。 在 这 种 情 
AF, SEOC) 为 零 ， 会 使 关节 变量 q(t) 跟踪 其 期 
望 值 gu(4) ， 从 而 产生 机 械 臂 轨迹 跟踪 问题 。 另 外 
一 个 例子 , EO) 表示 操作 空间 跟 踊 误差 , E(t) = 
x(t) - x(t) =e, (t) MAR hl E(t) BASSE 
望 运动 通常 已 经 指定 的 操作 空间 上 直接 产生 轨迹 
ERER o . 

为 了 得 到 机 械 辟 控制 器 设计 的 线性 状态 变量 模 
型 ， 就 要 对 输出 E(t) 进行 二 阶 微分 ， 可 得 





; rt eae +i (6. 32) 
£ =Tq + Tq +r 
其 中 ， 我 们 定义 一 个 〈p xn) 的 变换 敌阵 为 
_oh(q) _{ ah ah | oh 
Ta) = ag = (Sq, aq, a.) (6. 34) 
给 定 输出 Al), HAS hla) 相关 的 变换 和 矩阵 
T(g)。 在 表示 为 操作 空间 速度 误差 的 特殊 情况 下 ， 
T(q) RIR BEHN EERE Ja) o 


(6. 33) 


根据 式 (6.1), A 
q =H'(q)[T-n(q,q) | (6. 35) 
有 非 线性 项 的 表达 式 为 
n(gq,g)=C(g,q)g +T:(q) (6. 36) 


那么 ， 由 式 (6.33) 推 吕 出 


£ =7 +TY+T(g)H'(g)[T-n(g, 4)] 


(6. 37) 
定义 控制 输入 函数 为 
u= 7 +Tq+T(q)H'(q)(t-n(q, 0) 
(6. 38) 


现在 可 以 定义 状态 y(D) e R”, 由 y=(& £), WA 
辟 动 力学 方程 写 为 


l HERP (6.39) 
0 0 I, 
这 是 线性 状态 空间 系统 的 表达 式 

y =Ay + Bu (6.40) 


由 控制 输入 驱动。 由 于 4 AB 的 特殊 形式 ， 这 个 系 
统 被 看 做 是 布鲁诺 夫 斯 基 典 型 构成 ， 而 且 总 是 可 控制 
HW, SAA u(t) 

由 于 式 (6.38) 被 认为 是 对 机 械 臂 动力 学 方程 
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—— 


的 线性 化 变换 ， 进 而 通过 反 变 换 可 以 得 出 关节 转 矩 的 
表达 式 为 
T=H(q)T*(q)(u- f -Tq) +n(q,q) 
(6.41) 
AF, T 是 变换 矩阵 T(g) AE OR BS ah 
矩阵 。 

在 特殊 情况 下 二 =ey(i) ， 并 且 如 果 根 据 PD 反馈 
方程 w= —KpE—K,é, HEP u(t) ER (6.39) 稳 
E, 那么 T= -Io HA (6.41) 定义 的 控制 输入 转 
ETO) 会 使 机 械 臂 按照 使 y(t) 变 为 零 的 方式 运动 。 
在 这 种 情况 下 ， 反 馈线 性 化 控制 和 道 动力 学 控制 效果 
相同 。 


6.5.3 被 动 控制 


这 种 控制 方案 明确 地 使 用 了 拉 格 朗 日 系统 的 被 动 
性 性 质 “”” 。 较 之 逆 动 力学 方法 ， 被 动 控制 器 不 依 
赖 于 对 机 械 臂 非 线性 的 准确 去 除 ， 它 比 前 者 具备 更 好 
的 鲁 棒 特性 。 下 式 给 出 了 被 动 控 制 输入 。 
q.=qı+ae,, a>0 
T=H(g) q,+C(q, 9g)g,+Te(g) +Kye, +K,e, 
(6.42) 
通过 式 〈6.42) ， 可 以 得 到 下 面 的 闭环 系统 
H(q)s,+C(q,q)s,+K,é,+K,e,=0 (6.43) 
Hf, s,=e, + ae HREM MAK BH Vy, t) 
如 下 : 
,{eK,+K,+oa°H aH 
aH H ly (6. 44) 


II 


y sy 
= 

由 于 上 述 方程 是 正定 的 ， 所 以 它 在 原点 处 平衡 ， 即 

y=(e,, ê) =0. Wa, 了 由 下 式 限定 


Ta lly P Sy Py Sou lly one, >0 (6.45) 
将 V 对 时 间 求 导 得 到 
V =-ė'K,ė, -ae,K,e,=-y'Qy<0 (6.46) 


上 式 中 Q= diagl aK,, Ky], HY QO 是 正定 的 ,并 
且 是 了 的 二 次 函数 ， 所 以 也 可 以 得 到 下 面 的 限定 关 
系 式 


Ka ly Sy Qy<k«yllylP, «y=, >0 (6.47) 
然后 由 李 雅 普 诺 夫 函 数 了 的 限定 关系 得 到 
V<—x,lly|P = -277， n= (6. 48) 
最 终 可 以 得 到 
V(t) <V(O)e 7” (6.49) 


这 已 经 表明 a 的 大 小 会 大 大 影响 跟踪 结果 [3 Ea 
取 小 的 数值 情况 下 ， 机 械 臂 更 加 容易 发 生 振动 。 大 的 
a 值 对 应 着 更 好 的 跟踪 性 能 ， 并 且 在 位 置 误差 较 小 
时 ， 可 让 s, 避 免 受到 速度 测量 噪声 的 影响 。 参 考 文献 
[6.34] 表明 式 (6.50) 被 用 于 二 次 优化 。 


K, =aK, (6. 50) 


6.5.4 小 结 


本 市 回顾 了 到 目前 为 止 提出 的 一 些 基于 模型 的 运 
动 控制 方法 。 在 这 些 控制 方法 中 ,理论 上 讲 ， 闭 环 系 
统 能 够 提供 系统 的 渐 近 稳定 或 者 全 局 指数 稳定 。 然 而 
这 些 理想 的 状态 在 实际 情况 下 并 不 能 达到 ， 这 主要 由 
于 实际 的 系统 受到 采样 率 、 测 量 噪声 、 扰 动 和 未 建 模 
的 动态 参数 的 影响 “” ”1 。 
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多 年 来 ， 各 式 各 样 的 机 器 人 控制 方案 被 提出 来 。 
它们 中 的 多 数 可 以 被 视 为 将 线性 化 的 反馈 控制 方案 应 
用 于 非 线 性 系统 的 计算 转 矩 控制 类 方案 的 特例 (如 
图 6.5 所 示 )“”” 。 这 一 节 中 首先 介绍 计算 矩阵 控 
制 的 概念 ， 之 后 将 介绍 一 种 它 的 变形 形式 ， 所 谓 的 计 
FBR FET 
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C(q.qyq + Telg) 


图 6.5 ”计算 转 矩 控制 


6.6.1 计算 转 矩 控制 


回顾 式 (6.27) 中 的 控制 系统 输入 变量 


T=H(qg)v +C(q,q)q +T(9) 
ERRATA eH. EHS AERIAL EE 
补偿 回路 和 一 个 有 外 生 控 制 信号 2 的 外 部 回路 组 成 。 
将 这 种 控制 方案 应 用 于 机 器 人 机 械 臂 的 动力 学 模型 ， 
得 到 

g =v | (6. 51) 
需要 注意 的 是 ， 这 种 控制 输入 将 一 个 复杂 的 非 线性 控 
制 嚣 设计 问题 转化 成 了 一 个 由 半 个子 系统 组 成 的 线性 
系统 设计 问题 。 一 种 外 部 回路 控制 v 是 式 (6.28) 中 
所 示 的 PD Rit: 
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v=q,t+Kye,+K,e, 
这 种 情况 下 ， 总 的 控制 输入 表达 式 为 
T=H(q)(q, + Kye, +Kpe,) +C(q, q)q +Te(g) 
并 且 由 此 产生 的 线性 误差 动力 学 方程 为 
e,+K,e,+Kpe, =0 
根据 线性 系统 理论 ， 确 定 跟踪 误差 收敛 到 零 。 
备注 : 
一 般 情 况 下 ， 为 了 确保 误差 系统 的 稳定 性 ， 令 
及 和 天 为 mx 的 对 角 正 定 矩 阵 ， 即 K, = diag 
(Ky,, +, Kyn) >0, Kp =diag(Kp,, °° 
然而 ， 由 于 外 环 乘 法 器 到 (49) 和 内 环 完 全 非 线 性 
补偿 项 C(g，g ) 9g + Te(q) 扰乱 不 同 控制 通路 的 
关节 信号 ， 上 述 控 制 形式 并 不 能 得 到 关节 的 独立 
控制 。 


6.6.2 计算 转 矩 类 控制 


值得 注意 的 是 ， 若 想 应 用 计算 转 矩 控制 ,就 
需要 确保 动力 学 模型 的 各 个 参数 完全 已 知 ， 并 且 
控制 输入 信和 号 能 够 实现 实时 计算 。 为 了 避免 这 样 
的 问题 ， 提 出 了 -一些 变化 ， 例 如 计算 转 矩 类 控制 。 
计算 转 矩 类 控制 器 可 以 通过 修正 如 下 计算 转 朱 控 
制 得 到 : 


(6. 52) 


T=H(q)v +C(q, g)g +T(g) (6.53) 
式 中 ，^ 代 表 计 算 值 ， 并 且说 明了 理论 上 的 精确 反馈 


线性 控制 不 能 在 实际 的 不 确定 性 系统 中 实现 。 图 6.6 
为 该 类 控制 方案 的 示意 图 。 





图 6.6 计算 转 矩 类 控制 


L 具有 变 结构 补偿 的 计算 转 矩 类 控制 

由 于 系统 参数 的 不 确定 性 ， 为 实现 轨迹 跟踪 就 需 
要 在 外 回路 设计 中 设计 补偿 项 。 下 式 为 具有 变 结构 锌 
偿 的 计算 转 矩 类 控制 方案 的 表达 式 。 


v = q,t+Kye,+Kpe,+Av (6. 54) 
式 中 ， 变 结构 补偿 项 可 以 表达 为 
B' Px 
—-p(x, i) rr is if || BTPx || 0 
Av -| p(x, DT Bipxl (6.55) 
0, if||B’Px|| =0 


, Kpn) >0。 
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RP, x= (el, e')", B=(0, 71,) ,P 了 是 一 个 
(2n x2n) 的 满足 式 (6.56) FORE eK. 


PA+A'P=-0 (6. 56) 
式 中 ,年 阵 4 被 定义 为 
0 I, 
(ONY sn 


O 是 任意 一 个 合适 的 对 称 正定 矩阵 (2n x2n)。 


p(x, t) =— —[oB+ lIKlllzl+ Ho(x, 1)] (6.58) 


l -gQ 
RP, a 和 有 都 是 正常 数 ; HCA) -17,1<a< 
1 对 所 有 的 gs R ARNEE, H sup...) ll g u(t) I< B; 
K 是 一 个 (nx2n) 的 和 矩阵， 并 且 K=[K。 Ky]; 对 
ge R*"， AH SAn, HP, AWE; 
此 外 函数 中 定义 为 式 (6.59): 


ICCC, g) -Clq, g)lg +[Tte(g) -Te(g) llaol, t) 
(6.59) 
可 以 看 出 ,使 用 李 雅 普 诺 夫 函 数 式 (6.60) 可 以 使 
st (6.59) 的 跟踪 误差 收敛 到 零 。 
V=x' Px (6. 60) 
这 由 参考 文献 【6.5，40] 中 的 稳定 性 分 析 得 出 。 

注 : 

1) 由 6.1 节 中 的 性 质 6.1， 存 在 正 的 常数 A 与 
An HA, <A C SAn, EERE q ERR 
立 。 如 果 选 择 

入 = 一 1 (6.61) 


Agta 
RP, cs, MA 


Àn - À, 
一 —=a<l 
HTAR 


sk (6.62) 说 明 ， 对 于 相同 的 ae <1， 和 总 是 存在 


至 少 一 个 甩 满 足 关系 式 。 

2) 由 于 Av 存在 的 间断 点 ， 当 运用 控制 方案 时 
可 能 会 发 生 拌 振 现象 。 值 得 注意 的 是 ， 由 于 控制 中 高 
频 分 量 能 够 激发 未 建 模 的 动力 学 作用 (例如 关节 和 柔 
性 )， 拌 振 现象 经 常 是 不 可 预期 的 ”| 。 为 了 避免 
拌 振 现象 ， 采 用 变 结 构 补偿 的 方法 如 : 


B' Px ` T 
-p(x, OTB Pal 2 || B Px||>e 
Av = (6. 63 ) 


=p, prpx, | pT Px lle 
E 


RP, s 是 一 个 用 来 作为 边界 层 的 正常 数 。 根 据 这 一 
修正 ， 跟 踪 误 差 的 收敛 性 可 以 被 限定 在 一 定 的 残 差 集 
范围 内 ， 当 e 很 小 的 时 候 便 可 以 得 到 一 个 很 小 的 残 差 





|H-'(q)H(q) -4s (6. 62) 


118 第 1 篇 ”机 器 人 学 基础 
ON 


集 范围。 
2 具有 独立 关节 补偿 的 计算 转 和 矩 类 控制 
前 一 种 补偿 方案 是 集中 的 ， 这 就 意味 着 若 想 实 
现在 线 计算 需要 完成 大 量 的 计算 任务 ， 并 且 需 要 晶 
贵 的 硬件 作为 支持 。 为 了 解决 这 一 问题 ， 下 面 将 介 
绍 一 种 带 独立 关节 补偿 的 计算 转 矩 类 控制 方案 。 在 
这 种 计算 转 矩 类 控制 方案 中 ， 通 过 估计 得 到 下 述 关 
系 式 : 
H(q) =1, C(q, 4) =0, t(q) =0 (6.64) 
使 用 外 环 中 的 变量 ， 得 到 
v =Ky,e,+K,e,+Av (6. 65) 
式 中 ， 正 常数 选取 Ky AK, HEEK; Av =(0,, =, 
v) 中 的 第 ;个 分 量 Av ,定义 为 


Ei 


WUE |s, emim W- lga A 
B'oqa, qa) i é; 
Av,= 
MR |s; |> T £ -一 , 则 -Brw(g 4a) T 
B lgi, Va) 5; 
(6. 66) 
在 这 种 补偿 中 ， 3; = e qi + Aieg,i, Le | 1 ， on) n} 9 并 


且 4 为 正常 数 。 进 一 步 根据 机 械 臂 的 性 质 ， 可 以 
得 到 : 


|H(g) qstC(q, 9)gqa|+Ts(g) <p, + 
Bllal+l gall=g wl, q) 


HFA, =B, B, B), mA 

wo(q, 9) =[1, llgll, eli" (6. 67) 
Ba, e WARM A BK, iell, =, n}, 并 
且 满 足 

€,= -g,6;, €(0) >0, g, >0 (6. 68) 


这 里 值得 指出 的 一 点 是 控制 方案 中 的 变量 w 被 设计 
为 期 望 补偿 而 不 是 反馈 。 进 一 步 来 讲 ， 这 种 控制 方 
案 是 之 前 那 种 关节 独立 控制 的 一 种 形式 ， 并 且 具 备 
前 面 提 到 的 那些 优点 。 通 过 应 用 李 雅 普 诺 夫 函 数 可 
以 在 式 (6.69) 中 体现 跟踪 误差 近 渐 趋 于 零 这 一 
特点 : 


. AK, Ay\{é 
Vey (fe) | P 中 Ze; 
H A i=l 


AH 
(6. 69) 
它 沿 着 闭环 系统 轨迹 的 时 间 导 数 为 
- e | 
V=-a p (6.70) 
Ca 








WR Kp 和 YY 足够 大 ， 则 可 以 得 到 a 为 某 一 正常 数 。 
关于 稳定 性 的 详细 分 析 在 请 参考 文献 [6. 13 ] 。 


注 : 
与 具有 变 结构 补偿 的 计算 转 和 矩 类 控制 类 似 ， 考 虑 
如 下 的 非 零 边界 层 : 


E€; = -giEi, €(0) >0, ¢2,,a,>0 (6.71) 
根据 这 样 的 修正 ， 跟 踪 误 差 的 收敛 性 可 以 被 
限定 在 一 定 的 残 差 集 范围 内 ， 当 e 很 小 的 时 候 便 
可 以 得 到 一 个 很 小 的 残 差 集 范围 。 为 了 完成 点 到 
忆 的 控制 任务 ,设计 了 一 个 带 有 重力 补偿 的 PD 控 
HAF o 


H(q) =1, C(q, 4) =0, ts(g) =Te(g) (6.72) 
AF, Te(q) 是 机 械 臂 动力 学 模型 的 重力 项 。 
使 用 外 环 中 的 变量 >， 得 到 : 
v =K,e, +Kpe, (6. 73) 
在 这 样 的 情况 下 ， 控 制 输 入 变 为 
T=K,e, +K,e, +Ts(q) (6. 74) 


这 种 控制 方案 较 之 精确 地 计算 转 矩 控制 易于 实现 。 通 
过 应 用 李 雅 普 诺 夫 函 数 可 以 体现 跟踪 误差 逐渐 趋 于 零 
这 一 特点 ， 


V= THCa) è, tele, (6.75) 
它 沪 着 闭环 系统 解 轨 迹 的 时 间 导 数 为 
V = -eKye, (6. 76) 


关于 稳定 性 的 细节 分 析 在 参考 文献 [6.12] 中 
叙述 。 需 要 注意 的 一 点 是 ， 由 于 前 一 种 控制 方案 基于 
拉萨 尔 不 变 集 引 理 而 要 求 系统 是 自主 的 〈 不 随时 间 
变化 ) ， 这 一 结果 适用 于 调节 情况 而 不 是 轨迹 跟踪 
情况 。 

注 : 

如 果 忽 略 机 械 臂 动力 学 模型 中 的 重力 因素 ， 即 
Te(q) =0， 那 么 控制 法 则 变 为 

T=» =K,e,+K,e, (6.77) 

上 式 可 以 引出 纯 PD 控制 。 增 益 矩 阵 所 和 K,T 
以 选取 对 角 线 型 ， 从 而 使 PD 控制 成 为 基于 多 关节 动 
力学 模型 的 独立 关节 控制 的 形式 。 


小 结 和 扩展 阅读 


本 市 提 出 了 两 种 控制 方案 ; 计算 矩阵 控制 和 
计算 矩阵 类 控制 。 前 一 种 将 多 输入 多 输出 (MI 
MO) 的 非 线 性 机 副 人 系统 转化 成 了 一 个 非常 简单 
的 解 耦 的 线性 闭环 系统 。 因 为 前 一 种 控制 方案 的 
实际 运用 需要 事先 知道 所 有 的 机 械 臂 控制 参数 和 
它 的 有 效 载 向 ,使 它 显得 不 太 可 行 。 而 后 一 种 方 
案 放宽 了 上 述 的 约束 ， 且 仍旧 可 以 实现 目标 系统 


6. 6.3 
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的 不 确定 性 跟 踊 。 

参考 文献 [6.43] 研究 了 几 种 具备 前 馈 补 偿 的 
跟踪 系统 。 参 考 文献 【6. 19] 中 介绍 了 一 种 基于 了 一 
D 控制 的 自 适 应 控制 方案 。 


6.7 自 适应 控制 


自 适 应 控制 与 普通 控制 的 最 大 差别 是 自 适 应 控 
制 有 一 些 与 时 间 相 关 的 参数 ， 并 且 它 具有 根据 闭环 
系统 中 某 些 信 号 进行 在 线 调整 这 些 参数 的 机 制 。 即 
使 设备 中 参数 不 确定 ,这 种 控制 方案 仍然 可 以 达到 
控制 目标 。 本 节 中 我 们 介绍 几 种 在 机 器 人 机 械 臂 动 
力学 参数 信息 不 完全 的 情况 下 的 自 适应 控制 方案 。 
这 些 自 适 应 控制 方案 的 控制 性 能 基本 上 是 从 性 质 
6.5 得 出 的 ， 包 括 自 适应 计算 转 矩 控制 、 目 运 应 惯 
性 相关 控制 、 被 动 自 适应 控制 ， 以 及 具有 期 望 补偿 
的 自 适 应 控制 。 最 后 ,将 强调 在 参数 收敛 中 很 重要 
的 持续 激励 条 件 。 


6.7.1 自 适 应 计算 转 矩 控制 


计算 转 矩 控制 的 设计 很 有 吸引 力 ， 是 因为 它 人 允许 
设计 者 把 MIMO 高 度 耦 合 非 线 性 系统 转换 成 十 分 简单 
的 解 耦 线性 系统 ， 它 的 控制 方案 已 为 大 家 所 接受 。 但 
是 这 种 反馈 线性 化 方法 依赖 于 完全 的 系统 参数 信息 ， 
并 日 得 不 到 这 些 信 息 会 引起 错误 的 参数 估计 ， 导 致 误 
差 系统 的 闭环 模型 中 产生 不 匹配 项 。 该 项 可 以 理解 为 
在 闭环 系统 输入 处 的 非 线性 扰动 作用 。 为 了 解决 参数 
不 确定 的 问题 ， 我 们 考虑 下 式 有 参数 估计 的 道 动力 学 
方法 : 
tr=H(g)( gu+Rye, +Koe,) +C(g, 9) 4 +is(g) 
(6. 78) 
式 中 , H, C, t, AMH, C, Ts 同样 的 函数 式 。 由 
动力 学 模型 的 性 质 6.5 有 
Ala) d +C(g, 9g)g +T(qg) =Y(qg, 4, 4 )a 
(6.79) 
th, ¥(q, ġġ, F) 是 回归 量 ， 是 一 个 已 知 的 
(n xr) 函数 矩阵 ; a 是 简化 所 有 估计 参数 的 (rx1) 
向 量 。 把 控制 输入 rz 代入 械 臂 动力 学 方程 ， 得 到 闭环 误 
差 模型 
H(q)( €,+Kyé,+Kpe,) =¥(q, g, 9 )a 
(6. 80) 
式 中 ，& =a -a。 为 了 得 到 合适 的 自 适 应 法 则 ， 先 假 


设 加 速度 项 了 是 可 测量 的 ,而 且 估 计 惯 性 矩阵 
Alq) 不 是 奇异 的 。 为 方便 起 见 ， 误 差 方程 重 写 为 


x =Ax+BH'(q)¥(q, g, 9 )a (6.81) 
起 中 (er. è?) A 0, I, 3 0, 
x=(lé ; € ; = ， 一 
Res, EDn Aas e arh PS) 


(6. 82) 
自 适 应 法 则 可 以 认为 是 

2 =-I'Y"(q, 4, 4 )H~'(q) B'Px (6. 83) 
式 中 , 下 是 一 个 (r xr) 的 正定 常数 矩阵 ; P 是 
(2n x2n) 的 对 称 正定 常数 矩阵 ， 且 满足 : 

P4+4TP= -Q (6. 84) 

Ap, 0 是 有 相同 维度 的 对 称 正 定常 数 和 矩阵。 该 自 适 
应 法 则 有 两 个 假定 : 

1) 关节 加 速度 了 是 可 测量 的 。 

2) 未 知 参数 的 边界 范围 是 有 效 的 。 

第 一 个 假定 是 为 了 确定 回归 量 Y(q, q, 9) 是 
已 知 的 先 验 ， 而 第 二 个 假定 是 通过 将 估计 参数 a 限制 
在 真实 参数 值 范围 和 内， 以 保持 估计 量 H) 非 奇异 。 

实际 上 ， 李 雅 普 诺 夫 稳定 性 理论 和 李 雅 普 诺 夫 函 


数 ( 见 下 式 ) 能 确定 跟踪 误差 的 收敛 和 保持 所 有 内 
部 信号 有 界 。 


V = -x"Ox (6. 85) 


具体 的 稳定 性 分 析 在 参考 文献 【6.2j 中 详 述 。 

iE: 

由 于 实际 和 理论 上 的 原因 ， 上 述 的 第 一 条 假定 是 
很 难 使 用 的 。 在 多 数 情况 下 不 容易 做 到 加 速度 的 精确 
测量 ; 但 必须 确定 关于 这 个 扰动 的 上 述 自 适应 控制 方 
案 的 鲁 棱 性 。 此 外 ， 从 纯 理 论 的 角度 看 ,测量 9g，g ， 
d 意味 着 我 们 不 仅 需 要 整个 系统 的 状态 向 量 ， 还 需 
要 它 的 导数 。 
6.7.2 自 适 应 惯性 相关 控制 

这 里 介绍 另外 一 种 自 适应 控制 方案 。 本 他 提 出 的 
方案 不 需要 机 械 辟 加 速度 的 测量 值 ， 也 不 需要 估计 惯 


性 矩阵 的 转 置 ， 因 此 能 避免 自 适应 计算 转 矩 控制 方案 
的 不 足 。 我 们 先 看 控制 输入 

tT=H(q)v +C(q, q)v +is(g) +Kys (6.86) 
式 中 ， 辅 助 信号 v 和 s 定义 为 y= qs+Ae, As =» - 


g =e。+Ae,， 且 A 表示 (n xn) 的 正定 矩阵 。 根 
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据 动态 模型 的 性 质 6.5， 有 
H(q)v +C(q, q)v +T:(q) =¥(q, 9,0, 0)a 
(6. 87) 


str, ¥(- -) 是 一 个 已 知 时 间 函 数 的 
(nxr) 矩阵 。 式 (6.87) 和 自 适 应 计算 转 矩 控制 的 


参数 分 离 方 法 的 公式 是 同类 型 的 。 注 意 ，Z(9，7 ， 
v, 0) 是 独立 于 关节 加 速度 的 。 类 似 式 (6.87), 
我 们 得 到 
H(q)v +C(g, g)v +ie(g) =Y(g, og,v, 5)a 
(6.88) 
把 控制 输入 代入 运动 方程 ， 得 到 
H(q) 9 +C(g, 9)g +T(p) = 
H(g)v +C(g, g)v +C) +Kos 
HF g =v -s, 9 =v -5， 前 面 的 结果 能 重 写成 
H(q)s +C(q, q)s+K,s=Y¥(q,q,v,0v)a 
(6. 89) 


式 中 ，a =a -a。 自 适应 法 则 认为 是 


a=_IrY'(g, q,v,v)s (6.90) 
跟踪 误差 收敛 到 零 的 边界 上 所 有 内 部 信号 可 以 通过 李 
雅 普 诺 夫 稳 定性 理论 表示 ， 使 用 下 面 类 似 李 雅 普 诺 夫 
PRIS HY pa ŽI 


1 


= LH(g)s a'r a (6.91) 


2 
Ete AY Ag SE) a AY AT (SR 
V = -s"K,s (6.92) 
详细 的 稳定 性 分 析 参 见 参考 文献 【6.32] 。 
注 ， 
1) 之 前 学 到 的 自 适 应 计算 转 和 矩 控制 的 限制 在 这 


里 被 去 除了 。 

2) Kos 项 给 误差 系统 模型 引入 了 PD 型 线性 稳 
定 控制 作用 。 

3) 如 果 参 考 轨迹 满足 以 下 持续 激励 条 件 ， 
考 轨 迹 的 估计 参数 收敛 于 真实 参数 。 


fgtt . . . . 
al, <Í 7 (qa, Gdi.v,u)Y(q,, is Y, v )dt 
‘0 


则 参 


sol, 7 


其 中 ， 所 有 的 为， Œs» M ， 和 :都 是 正常 数 。 
6.7.3 被 动 自 适应 控制 
从 控制 的 物理 学 角度 我 们 能 看 到 ， 


由 于 目 适 应 控 . 


制 方案 的 发 展 ， 被 动 性 的 概念 变 得 很 普及 。 在 这 里 会 
说 明 被 动 性 的 概念 是 怎样 运用 到 设计 一 种 机 器 人 机 械 
辟 目 适应 控制 法 则 类 型 中 的 。 首 先 要 定义 一 个 辅助 滤 
波 跟 踪 误 差 信号 7 为 
=F'(s)e, (6. 93) 


其 中 ， 


F` (s) = [ sf, +—K(s)] (6.94) 


AP, s 是 拉 普 拉 斯 变换 变量 。 选 择 (nxn) 的 矩阵 
K(s), 使 F(s) 是 一 个 完全 合适 、 稳 定 的 传递 函数 气 
阵 。 如 之 前 的 方案 ， 自 适应 控制 策略 和 将 已 知 函 数 从 
林 知 常数 参数 中 分 离 出 来 的 能 力 有 密切 的 关系 。 使 用 
上 述 的 公式 定义 


Ze =H(q)[ gs+K(s)e, |] +V(g, q) 
ERLAR 
式 中 ，Z 是 已 知 的 (nxr) 回归 矩阵; o 是 自 适应 环 
境 中 未 知 系统 参数 的 一 个 向 量 。 注 意 到 上 式 可 以 改 


写 , 使 Z 和 7r 能 不 依赖 于 关节 加 速度 4 是 很 重要 的 。 
这 里 的 目 适 应 控制 方案 称 为 被 动 性 方法 ， 是 因为 


-r>Zo 的 映射 被 构造 为 被 动 映 射 。 即 ， 我 们 得 到 
了 一 个 身 适 应 法 则 ， 有 
[ ~r"(a)Z(a) (0) do = B 


总 是 满足 某 个 正 纯 量 常数 B。 这 类 自 适 应 控制 器 的 控 
制 输 入 为 


(6.95) 


T=Z0+Kyr 

详细 的 稳定 性 分 析 参 见 参 考 文献 [6. 44], 

备注 

1) WRR K(s), 
Z 和 7 将 不 依赖 于 4 。 

2) 通过 在 定义 r 中 选择 不 同 的 传递 函数 矩阵 
K(s), ， 可 以 由 自 适 应 被 动 控 制 方 法 产生 多 种 控制 方 
案 的 类 型 。 

3) 注意 ,定义 Kls) = sA, Œ F(s) =(s In-+ 
4) -! ， 控 制 输入 为 


T=Z -Kpr 


(6. 96) 


那么 H(s) 有 一 个 相对 度 ， 


H 


Zp=H(q)( G@4+Ae,) +C(g, G)( Gy +Ae,) + 名 (g) 
自 适应 法 则 可 能 被 选取 为 


p=TZ'(e, +Ae,) 
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以 满足 被 动 映射 条 件 。 这 表明 自 适应 惯性 相关 控制 可 
以 看 作 是 自 适应 被 动 控制 的 特例 。 
6.7.4 具有 期 望 补偿 的 自 适 应 控制 

为 了 实现 自 适 应 控制 方案 ， 需 要 实时 计算 了 (9， 
q, 9) 的 元 素 。 然 而 ， 这 个 过 程 会 非常 浪费 时 间 ， 
因为 它 涉 及 关节 位 置 和 速度 的 高 次 非 线性 函数 的 计 
算 ， 因 此 ， 这 种 方案 的 实时 实现 是 相当 困难 的 。 为 了 
克服 这 些 困 难 ， 这 里 提出 并 讨论 了 带 期 望 补偿 的 白 适 
应 控制 。 换 言 之 ， 用 期 望 变量 替换 变量 4，& 和 7 ， 
E, ga, qa 9 ,。 因 为 期 望 量 是 之 前 已 知 的 ， 所 
以 它们 相应 的 计算 可 以 离线 进行 ， 使 得 实时 实现 似乎 
更 可 行 。 我 们 考虑 控制 输入 

T=Y(gs, Qa, ga)a +k, s the, +k, lle, |Ps 

(6. 97) 

AP, ERR k, k, Mk, PK; 辅助 信号 :定义 
为 s= e+e,。 自 适应 法 则 认为 是 


â = -TY'(g, 4a, 9.8 (6.98) 
值得 注意 的 是 ， 在 控制 和 自 适 应 法 则 中 采用 了 期 望 补 
避 ， 使 计算 负荷 大 大 减少 。 便于 分 析 起 见 ， 我 们 注 
意 到 





I¥(q, q, q)a-Y(q:, qa, 9 a)als 
č lle l+ lle, IP +g lisli +g Ils lille, ll 
式 中 , f, fo, G, ML, BIER, A TERR 
Bn, mA: 
k, >% +Š, 


CHA, IARE k, kp, ALA, 值 应 该 足够 大 ) 。 李 雅 普 
诺 夫 稳定 性 理论 和 下 面 的 与 李 雅 普 诺 夫 方程 类 似 的 方 
程 能 证 明 内 部 信号 的 边界 内 的 跟踪 误差 收敛 于 零 。 

1 1 l 


as H(q)s + Zh ee, +a a 


其 中 ， 沿 着 闭环 系统 的 轨迹 的 时 间 导 数 推导 为 





V= (6.99) 


V < -x"Qx (6. 100) 


其 中 ， 
lle, I k, —§,/4 -61/2 
=| ay) o-| -61/2 k, -C3 - £474 j 


详细 的 稳定 性 分 析 参 加 参考 文献 【6. 45 ] 。 
6.7.5 小 结 和 扩展 阅读 


由 于 计算 转 矩 控制 容许 参数 的 不 确定 性 ， 内 此 提 
出 了 多 种 自 适应 控制 方案 。 首 先 介 绍 了 基于 计算 转 失 
控制 的 自 适 应 控制 方案 。 然 后 为 克服 之 前 提 及 的 不 
足 ， 如 关 刷 加 速度 的 可 测量 性 和 估计 惯性 年 阵 的 可 道 
性 ， 我 们 介绍 了 一 种 没有 这 些 不 足 的 替代 的 自 适应 控 
制 方案 。 最 近 ， 控 制 中 吸收 了 物理 学 的 观点 ， 自 适应 
被 动 控制 变 得 普及 了 ， 所 以 在 这 里 介绍 和 讨论 一 下 。 
最 后 ， 为 了 减少 自 适应 方案 的 计算 负荷 ， 我 们 介绍 了 
带 期 望 补 偿 的 自 适应 控制 。 

参考 文献 [6.46] 中 提出 了 一 种 处 理 刚 性 机 械 
壁 问题 的 自 适 应 控制 的 快速 计算 方案 。 通 过 假定 关节 
动力 学 是 解 看 的 (如 每 个 关节 被 认为 是 一 个 独立 的 
二 阶 线性 系统 ) ， 完 成 稳定 性 分 析 。 这 一 领域 的 其 他 
开创 性 的 工作 可 以 找到 ， 比 如 ， 在 参考 文献 【6. 47 ， 
48] 中 ,尽管 基础 的 动力 学 模型 性 质 一 个 也 没 使 用 ， 
却 还 是 考虑 到 了 完整 的 动力 学 ,但 是 控制 输入 是 不 连 
续 的 ， 会 引起 拌 振 。 虽 然 假 定 自 适 应 中 某 个 时 变量 保 
持 为 常数 ， 在 参考 文献 [6.49] 节 中 明确 使 用 了 惯 
性 矩阵 的 正定 性 。 很 有 意思 的 是 所 有 的 这 些 方案 都 是 
基于 参考 文献 [6.50] 中 为 线性 系统 提出 的 模型 参 
考 自 适应 控制 《MRAC) 概念 。 因 此 ， 概 念 上 它们 与 
本 节 所 介绍 的 真实 非 线 性 方案 十 分 不 同 。 

参考 文献 [6.51] 和 16.52] 中 ,提出 了 一 种 
基于 被 动 性 的 修正 版 的 最 小 二 乘 估计 方案 ， 它 确定 了 
方案 的 闭环 稳定 性 。 在 参考 文献 [6.53] 能 找到 其 
他 方案 ， 其 中 没有 用 到 反对 称 性 质 。 在 参考 文献 
[6.54] 中 ， 递 归 的 牛顿 - 欧 拉 方程 用 来 代替 拉 格 六 
日 方程 推导 机 械 臂 的 动力 学 方程 ， 央 此 ， 简 化 的 计算 
帮助 了 实际 应 用 。 

里 然 自 适应 控制 提出 了 解决 参数 不 确定 性 问题 的 
方法 ， 但 是 和 适应 控制 器 的 鲁 棒 性 问题 在 这 一 领域 仍 
是 一 个 非常 有 趣 的 课题 。 确 实 ， 测量 噪声 或 未 建 模 动 
J (m, FE) 会 产生 无 界 的 闭环 信和 号。 特别 地 ， 
估计 参数 会 发 散 一 一 这 是 上 自 适 应 控制 中 一 种 众所周知 
的 现象 ， 称 为 参数 漂移 。 参考 文献 [6.55] 和 
[6.56] 中 研究 了 由 线性 系统 自 适应 控制 得 出 的 方 
法 ， 其 中 修正 的 估计 值 确定 估计 值 的 边界 。 在 参考 文 
献 [6.57] 中 ,为 了 加 强 鲁 棒 性 ， 人 和 修正 了 参考 文献 
[6.32] 中 的 控制 硕 。 


6.8 最 优 和 和 鲁 棒 控制 


已 知 一 个 非 线性 系统 ， 例 如 机 器 人 机 械 臂 ， 人 
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们 能 够 设计 许多 稳定 化 的 控制 器 “** 。 换 言 之 ， 
控制 系统 的 稳定 性 不 能 确定 一 个 唯一 的 控制 器 。 很 
自然 地 ， 人 们 在 许多 的 控制 器 中 寻找 一 个 最 优 的 控 
制 妖 。 然 而 ， 只 有 在 有 目标 系统 相当 精确 的 信息 情 
况 下 ， 例 如 精确 的 系统 模型 ， 一 个 最 优 的 控制 器 设 
计 才 是 有 可 能 的 “”* i。 当 存 在 实际 系统 与 其 数学 
模型 之 间 的 不 一 致 时 ， 一 个 设计 的 最 优 控制 器 就 不 
再 是 最 优 的 ， 甚 至 可 能 在 真实 系统 中 最 终 是 不 稳定 
的 。 一 般 来 说 ， 最 优 控 制 设计 架构 并 不 是 解决 系统 
不 确定 性 最 好 的 一 个 。 为 了 处 理 控制 设计 阶段 的 系 
统 不 确定 性 ， 需 要 一 个 鲁 棒 控制 设计 架构 “” E 
棒 控 制 的 主要 目标 之 一 是 即使 数学 模型 或 未 建 模 的 
动力 学 等 中 存在 不 确定 性 ， 也 要 保持 所 控制 系统 的 
稳定 性 。 

考虑 一 个 由 如 下 非 线 性 时 变 微分 方程 描述 的 仿 射 
非 线 性 系统 ， 其 中 


X=(%, My TU, x) E R” 


x(t) =f(x, t) +G(x, t)u+P(x,t)w (6.101) 
AH, we R” 是 控制 输入 ; WER 是 扰动 。 不 考虑 护 
动 或 未 建 模 动力 学 ， 系 统 简化 为 

x(t) =f(x, t)+G(x, t)u (6. 102) 
实际 上 ， 根 据 控 制 目 标 存在 许多 种 描述 非 线性 系统 的 
方法 1,16. 21,23,34,53] o 


二 次 型 最 优 控制 
每 一 个 最 优 控 制 絮 都 是 基于 它 自己 的 成 本 函 
BO 8) 。 我们 可 以 这 样 定义 它 的 成 本 函数 
z=H(x, t)x+K(x, t)u 
有 H'(x, t)K(x, t) =0, K'(x, t)K(x, t) = 
R(x, 1) >0, H H'(x, tj)H(x, t) =Q(x, t) >0， 
于 是 有 


6.8.1 


l r _ l r l r 
3% z= Be O(x, i)x+ 7 R(x, t)u 


对 于 一 个 一 阶 可 微 正定 函数 ， 通 过 解 以 下 汉 密 尔 
Wi- 雅 可 比 -贝尔 曼 (HJB) 方程 “”” ， 从 而 找到 系 
统 的 二 次 最 优 控制 式 (6. 102) 。 

0=HJB(x, t; V) =V,(x, 1) + V(x, t)f(x, t) 


-FV.(x, 1) G(x, R(x, t) 


G(x, VICE, 8) + Q(x, 1) 


于 是 这 个 二 次 最 优 控 制 可 定义 为 


u= -R (x,t)G (x, iVi(x,t) (6.103) 
注意 HJB 方程 是 一 个 非 线 性 二 阶 偏 微分 方程 。 
不 像 之 前 提 过 的 最 优 控 制 问 题 那样 ， 所 谓 的 逆 二 
次 最 优 控 制 是 为 了 找到 一 组 Q(x, t) 和 R(x, t), 
使 得 HIB 方程 有 解 V(x,，i) 。 逆 二 次 最 优 控 制 于 是 可 
以 定义 为 式 (6. 103)。 


6.8.2 非 线 性 无。 控制 


当 扰 动 无 法 忽略 的 时 候 ， 可 以 这 样 来 处 理 扰动 
作用 


fz", T)z(x,T)dT< al w'wdT (6, 104) 


AF, y >0 给 定 了 从 扰动 输入 w 到 成 本 变量 z 的 闭 
环 系 统 的 增益。 这 被 称 为 L 增益 的 衰减 要 求 。 非 
线性 CR。 最 优 控 制 给 出 了 一 种 设计 最 优 和 重 棒 控 制 的 
系统 化 方法 。 令 y>0 已 知 ， 解 以 下 方程 : 

HJI, (x, t; V) =V,(x, t) + V(x, t)f(x, t) 


-5 V.C, 1) {G(x, DR 
(x, t)G' (x, t) ~y” P(x, t) 
P(x, t)}V, (x, 1) + 本 CQ(z， t) <0 


(6. 105) 
于 是 控制 定义 为 : 
u= —-R'(x, t)G'(x,t)Vi(x, 2) (6.106) 

这 个 偏 微 分 不 等 式 被 称 为 汉密尔顿 -雅克 比 - 艾 
萨 克 ( HJI) 不等式。 那么， 可 以 定义 道 非 线性 Fe. 
最 优 控制 问题 ， 该 问题 可 以 找到 一 组 Q(x, t) 和 
R(x，1) ， 使 得 对 一 个 指定 的 L, May, ABN TS L 
增益 要 求 “% 。 

有 两 件 事 值得 进一步 讨论 。 第 一 ,天 增益 要 求 
RXT L, 范 数 〈 欧 几 里 德 距离 ) 是 有 界 的 扰动 信号 w 
有 效 。 第 二 , Ho 最 优 控制 的 定义 不 是 唯一 的 。 因 此 ， 
我 们 可 以 从 众多 的 死 。 最 优 控制 器 中 选 出 一 个 二 次 最 
优 的 。 准 确 地 说 ， 由 于 期 望 的 L 增益 是 指定 的 先 验 ， 
那么 这 个 控制 (6. 106) MARERE H 的 次 优 控 制 。 
一 个 真正 的 死 。 最 优 控 制 是 找到 使 5 增益 要 求实 现 
的 y 为 最 小 值 。 


6.8.3 JERTEH. 控制 的 被 动 设计 


有 许多 设计 最 优 和 (或 ) 鲁 棒 控制 的 方法 。 其 
中 ,被动 控制 可 以 充分 利用 上 面 所 描述 到 的 性 
质 “”。 它 包括 两 部 分 : 一 个 来 自 保留 了 系统 被 动 性 
的 参考 运动 补偿 ， 另 一 个 则 要 达到 稳定 性 、 鲁 棒 性 和 
(或 ) 最 优 性 ““” 。 


第 6 章 


假设 ,动力 学 参数 被 确定 为 H(g), Clq, @) 
和 Te(g)， 它 们 的 对 应 部 分 分 别 是 H(g), Clq, @) 
和 Ts(q)。 那 么 ， 被动 控 制 会 产生 下 面 的 跟踪 控制 
法 则 : 
T = H(q) "P +C(q, q ) ces +Te(g) —u 
(6. 107) 
RH, @ ,是 参考 加 速度 ， 定 义 为 : 
De = Fat Kye, + Kye, (6. 108 ) 
AHP, K =diag{k,, i} >0; K, =diagikp, i} >0, 
参考 加 速度 产生 中 涉及 两 个 参数 。 有 时 可 以 采用 下 面 
的 替代 方法 : 
d i = q a + Kye, 
这 减少 了 闭环 系统 的 阶 数 ， 因 为 当 式 (6. 108) 
的 定义 要 求 状态 x = (feT eT et) 时 ,状态 x = (el, 
27)" 对 于 系统 描述 是 充分 的 ， 控 制 下 的 闭环 动力 学 


由 下 式 给 出 
H(q) és +C(qg, 0)ew=z+m (6.109) 





图 6.7 根据 公式 (6.109) 的 闭环 系统 


其 中 ， 
Cg A +K, e, + Ke, 
es = e, + Kye, + K, fe, 
如 果 d(t) = 0, HH=H, C=C, fs =T:, 则 w=0。 
ll, tae LA 


mw =H(q) Gir + CCQ, I) Ve + Te(Q) +d(t) 


(6. 110) 
ath, H=H-H; C=C-C; T=î, -Te 特别 有 
意思 的 是 ， 该 系统 (6.109) 定义 了 从 w+w 到 6. 的 
被 动 映射。 
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根据 这 种 方法 ， 辅 助 控制 输入 z 是 指定 的 ， 被 动 
控制 可 实现 稳定 性 、 重 棒 性 和 《或 ) 最 优 性 。 


6.8.4 FIERTE 死 。 控制 问题 的 解决 方案 
通过 参考 误差 反馈 定义 辅助 控制 输入 
u= -aR (x, t)e (6. 111) 


其 中 ,a>1 是 任意 的 。 那 么 ， 控 制 提供 了 逆 非 线性 
Ha 最 优 性 。 
定理 6. 1: 逆 非 线性 只。 RRE S. 
使 参考 加 速度 产生 增益 矩阵 六， 和 于, ， 且 满足 
Ki, >2K, (6. 112) 
那么 ， 对 于 一 个 给 定 的 y>0， 参 考 误差 反馈 


u=-Ke,,= -K(e, + Kye, + KE fe,) 


(6. 113) 
对 于 

KK, 0 0 
Q=| 0 (K,-2K,)K, 0 (6. 114) 

0 0 K, 
R=K"™ (6. 115) 

WE L, 增益 衰减 要 求 。 

其 中 K, =K- 1>0 (6. 116) 


给 定 y， TRK =a -1 Ha>l, 得 到 K, = 
(a-1)57 
Y 


4 ABR eB wz a PE, = 


diag|m,|} ， 应 该 设 C=0。 此 外 ， 可 以 设 t, =0, MHE 
tH TARREI PID 控制 的 表达 式 : 


Ti = m,;( qai t ky qi 十 kp, K 


1 
FOE (eae + ky, ieai + kp ifea: | 
7 na aA 1 * 
E = Go, + (iby, + ar). 


= ky ; kp, i 
+ | mikp i + az en: + & Egi 
kJ Y Y 


(6.117) 
这 就 推出 了 具有 期 望 加 速度 前 馈 的 PID 控制 “”; 
(6. 118a) 





wee eo * * 
Ti = miqa i t by, seq + kpieqs + kriegi 
AP, 


124 第 1 篇 


Thi (6. 118b) 
(6. 118c) 


(6. 118d) 


6.9 数字 化 实现 


前 面 介 绍 过 的 控制 器 ， 大 多 数 都 可 以 在 微 处 理 器 
上 数字 化 地 实现 。 本 节 讨 论 基本 但 是 实质 的 计算 机 实 
现 相关 的 实践 问题 。 当 控制 器 是 在 计算 机 控制 系统 中 
完成 的 时 候 , 读 取 的 是 模拟 输入 ， 输 出 为 一 个 特定 采 
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样 周期 下 的 输出 。 由 于 采样 会 在 控制 闭环 中 引信 时 间 
延迟 ， 因 而 这 是 与 模拟 实现 相 比 的 一 个 不 足 之 处 。 图 
6. 8 展示 了 有 数字 化 实现 的 控制 系统 的 总 框图 。 当 用 
数字 计算 机 实现 控制 法 则 的 时 候 ， 很 方便 用 中 断 程序 
将 代码 序列 分 成 四 个 过 程 程 序 ， 如 图 6.9 所 示 。 以 正 
确 的 频率 从 传感器 读 取 输入 信和 号， 同步 将 控制 信号 写 


到 数 模 (D/A) 转换 器 是 非常 重要 的 。 因 此 ， 这 些 过 
程 放 在 第 一 个 程序 中 。 在 存储 了 计数 器 的 值 并 提取 了 
D/A 值 后 (这 些 值 已 经 在 上 一 步 计 算 过 ) ， 下 一 步 程 
序 将 产生 参考 值 。 带 滤波 的 控制 程序 遵循 并 产生 纯 量 
或 向 量 的 控制 输出 。 最 后 ， 给 出 检查 参数 值 的 用 户 接 
口 ， 并 被 用 来 调节 和 调试 。 


-> Y (/) 


图 6.8 系统 控制 的 数字 化 实现 


Control_interrupt() 


i 


Read_Write(); 
Reference_Generate(): 
Output_process(); 


Output_Debug(); 





图 6.9 数字 控制 中 断 程 序 的 序列 


6.9.1 参考 轨迹 生成 


参考 轨迹 生成 是 一 个 起 点 ， 用 做 控制 的 目标 值 。 
它 是 一 组 在 控制 处 理 器 中 每 个 中 断 的 设 定点 的 值 ， 所 
以 被 称 作 运 动 轮 廊 。 有 既然 实际 上 此 时 伺服 控制 的 目标 
不 是 点 对 点 控制 ， 而 是 轨迹 跟踪 ， 那 么 设计 好 这 个 轮 
廓 就 非常 重要 了 ， 因 为 跟踪 和 定位 误差 对 此 十 分 敏 
感 。 一 般 梯形 轮廓 是 很 好 计算 的 ， 在 加 速 和 减速 期 间 
需要 恒定 电流 。 然 而 ， 运 动 两 端 发 生 大 的 抖动 会 引起 
振动 。 大 的 抖动 (加 速度 的 迅速 改变 ， 及 相应 的 力 
的 迅速 改变 ) 可 能 会 对 动力 学 系统 造成 实质 性 损害 
和 引起 不 希望 的 振动 。 因 此 ， 需 要 平滑 的 轮廓 ， 尽 管 
这 需要 更 多 的 计算 时 间 。 一 个 使 用 三 次 多项式 的 简单 
运动 轮廓 如 下 : 
y(t) =a +bt +c? +dt 
y(t) =b +2ct + 3d? 
y (t) =2c +6di 
实际 上 ， 运 动 轮廓 方程 是 标准 化 的 ， 并 且 可 以 编 


ARK, HARY: 


y(0)=0, y(1)=1 


y(0)=0, y(1)=0 


当 运动 时 间 和 距离 是 标准 化 的 时 候 ， 程 序 代码 采 
HR (6.119) 中 所 示 的 式 子 。 


(r) [eel] 
7 (F) -区 8， (6. 119) 


式 中 ，$ 代表 距离 ，7 代表 运动 时 间 。 
对 于 高 速 伺服 系统 ， 拌 动 轮廓 在 运行 的 开始 和 结 
束 是 不 变 的 。 这 意味 着 需要 很 高 的 机 械 刚 度 。 即 使 计 
算 负荷 增加 了 ，15 甚至 17 次 多 项 式 也 可 以 设计 来 满 
足 加 速度 或 抖动 约束 。 
运动 轮 廊 经 常 以 表格 或 中 断 程序 “Reference-_ 
Generate ()” 的 形式 保存 在 只 读 存 储 角 (RONM ) 中 ， 
如 图 6. 9 所 示 。 在 大 多 数 跟 踪 伺服 控制 问题 中 ， 需 要 
生成 位 置 轮 廊 。 但 是 ， 速 度 和 加 速度 也 在 中 断 程序 中 
实时 计算 ， 用 做 前 馈 控 制 的 输入 。 这 些 方法 改善 了 跟 
踪 性 能 ， 其 算法 如 下 : 
Pos „ = PosTable( pointer) x Distance; 
Vel e = POS et 一 os,orp 


(6. 120) 


Acc..r = Vel or 一 Vel us op 


式 中 ，Vel 和 Act sep FEAR RE SE Pas SH HH E FAT BBE, 
它们 分 别 表示 在 实际 使 用 中 与 中 断 时 间 间 隔 成 比例 的 
参考 速度 以 及 与 中 断 时 间 问 隔 的 平方 成 比例 的 加 速 
度 。 此 外 ， 当 使 用 在 式 (6. 120) 中 的 简单 差分 公式 
从 位 置 轮廓 计算 速度 轮廓 时 ， 由 于 重要 数字 信号 的 于 
失 ， 数字 信号 处 理 器 (DSP) 或 处 理 器 的 有 限 的 寄存 
器 大 小 可 能 引起 误差 。 这 意味 着 ， 速 度 轮 廓 中 含有 周 
期 性 的 噪声 信号 。 当 速度 、 加 速度 和 拌 动 的 轮廓 用 做 
高 速 跟踪 的 前 馈 控 制 系统 的 输入 时 ， 这 种 数字 误差 将 
在 运动 中 产生 真实 的 噪声 ， 并 且 降 低 控 制 系统 的 
性 能 。 

可 以 使 用 数值 微分 方程 ， 而 不 用 式 (6. 120) 中 
的 简单 差分 。 方程 (6.121) 给 出 了 一 阶 向 后 -差分 
方程 的 最 简 形 式 : 
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"J Yl 
y = At ; 
: k Yk] k-2 
, AT (6. 121) 
vas YTY +34, 9 — Yr-3 
Yk At? 
如 果 存 储 容 量 足 够 大 ， 以 表格 的 形式 保存 每 个 轮 
廓 可 能 是 为 一 种 好 方法 。 


重要 的 是 ， 所 控制 的 系统 运动 的 最 大 的 规格 参 
数 ， 如 ， 速 度 或 加 速度 ,或 者 其 至 是 样 动 ， 应 该 在 轮 
廊 设 计 步 又 中 予以 考虑 。 如 果 轮 廓 强迫 系统 超出 最 大 
规格 参数 值 ， 由 于 编码 器 脉冲 值 的 丢失 ， 会 大 大 增加 
系统 发 生 碰 撞 事 故 的 可 能 性 。 


6.9.2 代码 的 Z 变换 


通过 使 用 Z 变换 可 以 将 连续 时 间 系 统 变 换 到 离 
散 时 间 系 统 。 尽 管 物理 过 程 仍然 是 一 个 连续 时 间 系 
统 ， 但是， 离散 时 间 系 统 用 于 获取 采样 点 处 给 出 物理 
过 程 行为 的 数学 模型 。 拉 普 拉 斯 变换 用 于 分 析 在 S 域 
上 的 控制 系统 。 在 大 多 数 情况 下 ， 控 制 器 和 滤波 天 的 
设计 都 使 用 了 在 S 域 上 的 工具 来 完成 。 为 了 使 用 程序 
代码 来 实现 这 些 结 果 ， 了 解 Z 变换 是 必 不 可 少 的 。 
所 有 在 S 域 上 设计 的 控制 器 和 滤波 器 都 可 以 容易 地 通 
过 Z 变换 编译 成 为 一 段 程 序 代码 ， 这 是 内 为 它 有 数 
字 化 的 差分 序列 公式 。 
以 一 个 编码 的 PID 控制 器 为 例 。 在 传递 水 数 的 式 
中 ， 这 种 控制 需 的 基本 结构 是 
Y(s) 
E(s) 
从 频 域 到 离散 域 的 转换 有 几 种 不 同 的 方式 。 为 了 
保持 稳定 性 ， 经 常 使 用 向 后 欧 拉 算 法 和 塔 斯 洒 算法 。 
虽然 塔 斯 汀 算法 被 认为 是 一 种 更 为 准确 的 算法 , 但 是 
下 面 采用 了 向 后 欧 拉 算 法 。 
把 向 后 欧 拉 方程 代入 式 (6. 122) ， 有 


z-i 








K, 
=Kp t- +sKy (6. 122) 





s= 


zT 
得 到 下 面 的 离散 式 
Y(z) w+pBz- + yz"? 
E(z) -= Tor) (6. 123) 
其 中 ， 


a=K T +K,T+K,; 
B=-KT-2K; 
y =Kyo 
现在 ， 可 以 用 差分 方程 重新 整理 为 : 
Ty, -Yr-1) =aer+Be i++7et-3 
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1 
Yr = Yl + (ae + Bex; + Yer_2) 


Ye -Yri = + he + er + Ye (6.124) 
这 个 公式 可 以 直接 被 编译 为 代码 : 
er = Px, ref =P: 


r 
€r TVk, ref 一 让 


= (Dy. ref ~ Pk-1, ref) 一 (ps — PR-1 ) 
二 Cr nd ot 
k 


sum; = suni + er = Sie, 
1=0 


y, = Kp e€; + Ky, o(e, —&%-1) 十 天 sum, 
Yy Veni = (Kp. c€ — Kp. .er_1) 
+ [Ky .(e,-e-1) J 
- [ Ky, (er 一 ek-2) J 
+ (K, ,sum, ~ K, esum}; ) 
= (Kp, + Ky. + Ky, ex 
- (Kp +2K, .)e,.) + Ky .er_2 
(6. 125) 
式 中 ，p, 是 现在 的 位 置 ; v; 是 当前 速度 ; 下 标 ref 代 
表 参 考 ; Fire 代表 代码 。 比 较 式 (6.124) MA 
(6.125) 的 参数 ， 可 得 


a 


Ky 
A Kp + + KT = (Kp, e Ky, e + Ki, 0) 


2K 
$- -Kp -7 = - (Kp. +2Ky .) 


T T 


这 表明 在 增益 的 设计 和 编码 的 式 子 之 间 存 在 关联 : 
Kp. = Kp 


K 
Tomek, . 


K, ,=K,T (6. 126) 

随 着 同一 系统 中 采样 频率 的 增加 ， 编 码 的 Ky 增 

益 应 该 增加 ， 同 时 编码 的 K 增益 应 该 降低 。 使 用 这 

种 方法 所 设计 的 控制 器 可 以 在 DSP 或 微 处 理 器 中 进 

行 编译 。 尽 管 如 此 ， 对 于 控制 算法 的 分 析 和 仿真 应 该 
事先 充分 演算 ， 才 能 得 到 控制 系统 的 优异 表现 。 


6.10 ”学习 控制 


由 于 许多 机 器 人 应 用 ， 比 如 拾取 与 放置 操作 、 喷 
漆 、 电 路 板 组 装 等 等 ， 都 涉及 重复 性 的 运动 ， 人 们 日 
然 会 考虑 利用 以 往 周期 中 收集 的 数据 来 改善 机 械 辟 在 
随后 周期 中 的 性 能 。 这 就 是 “重复 控制 ”或 “学 习 


控制 ”的 基本 理念 。 考 虑 在 6. 1 节 中 给 出 的 机 器 人 模 
型 ， 并 假设 给 定 一 个 在 有 限 的 时 间 间 隔 0<1<7 内 
的 期 望 的 关节 轨迹 q,(1) 。 参 考 轨迹 gs 被 用 在 机 械 臂 
的 重复 轨迹 中 ， 这 里 或 者 假设 运动 轨迹 是 周期 性 的 ， 
qa(T) =gs(0) 〈 即 重复 控制 ) ， 或 者 假设 机 器 人 在 每 
次 轨迹 的 开始 都 被 重新 初始 化 ， 使 之 位 于 期 望 轨迹 上 
( 亦 即 学 习 控制 )。 下 文中 ， 我们 将 用 “学 习 控 制 ” 
这 个 词 代表 “重复 控制 ”或 者 “学 习 控制 ”。 


6.10.1 纯 P 型 学 习 探 制 


FAT, 表示 第 个 周期 中 的 输入 转 矩 ， 并 产生 输 
E g(t), HPO <t < Ti。 现在 我 们 考虑 如 下 假设 : 
1) 假设 1: 每 次 实验 都 在 固定 的 时 间 期 限 T, > 
0 时 结束 。 
2) 假设 2: 满足 初始 设置 的 重复 性 。 
3) 假设 3: 整个 重复 轨迹 中 系统 的 动力 学 不 变 
性 是 确定 的 。 
4) 假设 4: 每 个 输出 % 都 是 可 测量 的 ， 从 而 误 
差 信 号 Ag, =q, -gs 可 以 用 来 构造 下 一 个 输 人 so 
5) 假设 5: 机 器 人 机 械 臂 的 动力 学 是 可 逆 的 。 
由 此 学 习 控 制 问题 被 归结 为 确定 一 个 递归 学 习 法 
则 工 
T, =L[T, (1), Aq,(t)], OStST,, (6.127) 
sth, Ag (t) =9.(t) -qs(t)， 使 得 在 某 些 适 当 定 
义 的 函数 范 数 中 -上 丰 ， 当 有一 % 时 ，j|Agi 1 一 0。 
初始 控制 输入 可 以 是 任何 一 个 能 够 产生 稳定 输出 
的 控制 输入 ， 比 如 PD 控制 。 这 样 的 学 习 控 制 方案 
之 所 以 有 吸引 力 ， 是 因为 动力 学 的 精确 模型 不 需 
要 是 先 验 的 。 
已 经 有 几 种 方法 用 来 得 出 一 个 适当 的 学 习 法 则 
LL， 以 及 证 明 输 出 误差 的 收敛 性 。 纯 P 型 学 习 法 则 是 
其 形式 之 一 : 
Tasi (t) =T(t) - BAg,(t) (6. 128) 
之 所 以 起 了 这 个 名 字 ， 是 因为 在 每 次 迭代 的 过 程 中 ， 
输入 转 矩 的 修正 项 都 是 和 误差 Ag 成 正比 的 。 现 在 让 
Tt 用 计算 转 矩 控制 来 定义 ， 亦 即 ， 
T(t) =H[qgs(t)]1 @ a(t) +Clqalt), 
g(t) ]qa(t) +Telga(t)] (6. 129) 
应 该 记得 ， 函 数 五 实际 不 需要 计算 的 ， 只 需要 知道 
它 存在 即 可 。 对 于 了 型 学 习 控制 法 则 ， 我 们 有 
AT, (t) =AT,(t) - BAg, (t) (6. 130) 
Hp, AT, (t) =Ti(t) -Ta(t), 使 得 
IAT E) PS A EC) IP - Bll @dg, Cc) If 
(6.131) 
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如 果 存 在 正常 数 A 和 有 B， 那 么 对 于 任意 的 大 ， 有 
[evAagArn()d > || wag, (1) IP 


(6. 132) 
接 下 来 它 遵循 不 等 式 (6.132) ， 并 在 范 数 意 义 上 ， 
当 ji 一 oo ，Aqi 一 0。 这 种 控制 方案 的 详细 稳定 性 分 析 
在 参考 文献 【6. 68 69] 中 给 出 。 


6.10.2 带 遗 忘 因子 的 P 型 学 习 探 制 


虽然 纯 P 型 学 习 控 制 已 经 达到 了 预期 的 目标 ,但 
是 在 实际 情况 下 一 些 严格 的 假设 可 能 是 不 成 立 的 ， 例 
如 ， 可 能 有 初始 设置 错误 。 此 外 ， 还 有 可 能 有 虽然 小 
但 是 不 可 重复 的 动力 学 波动 。 最 终 ， 有 可 能 返回 一 个 
(有 界 的 ) WERE g, HA 
Aq, (i) +E) = [g(t) +E) | -4a C) 
(6. 133) 
因此 ， 学 习 控 制 方案 可 能 会 无 效 。 为 了 提高 P 型 学 习 
控制 的 鲁 棒 性 ， 在 递 推 式 中 引入 一 个 遗 息 因子 
Tt) =(1-a@)T, (4) +a T(t) 
-P| Ag,(t) +é (t)] (6. 134) 
最 初 将 遗忘 因子 引入 学 习 控 制 的 想法 来 源 于 参考 文 
献 [6.70], 
已 严格 证 明了 ， 带 有 遗忘 因子 的 P 型 学 习 控 制 可 
以 确定 函数 收敛 到 一 个 期 望 的 大 小 为 Ola) 的 邻 域 。 
此 外 ， 如 果 长 期 记忆 的 内 容 在 每 % 次 试验 后 都 被 刷 
新 ， 其 中 为 0(1/a) ， 那 么 轨迹 就 会 收敛 于 一 个 期 
望 控 制 目标 的 e 邻 域 。e 的 大 小 依赖 于 初始 设置 误差 
的 幅度 、 动 力学 的 不 可 重复 波动 以 及 测量 噪声 。 详 细 
的 稳定 性 研究 ， 请 参考 文献 [6.71, 72]. 


6.10.3 小 结 与 扩展 阅读 


应 用 学 习 控 制 ， 通过 利用 以 往 周期 中 收集 到 的 数 
据 ， 重 复 性 任务 〈 例 如 喷漆 或 拾取 -放置 操作 ) 的 执 
行 得 到 了 改善 。 在 本 节 中 ， 我 们 介绍 了 两 种 学 习 控 制 
方案 。 首 先是 纯 P 型 学 习 控 制 ， 并 对 其 鲁 棒 性 问题 进 
行 了 阐述 。 接 下 来 介绍 了 带 遗 忘 因子 的 P RUA g 
制 ， 这 种 方法 提高 了 学 习 控制 的 鲁 棒 性 。 

对 于 学 习 控制 的 严格 和 完备 的 探究 首先 在 参考 文 
献 [6.2，12] 中 独立 地 进行 了 讨论 。 
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B7 J 控 制 


Luigi Villani, Joris De Schutter 
重 明 译 


处 理 好 机 器 人 与 周围 环境 之 间 的 接触 是 成 功 
完成 作业 任务 的 一 个 基本 要 求 。 纯 运动 控制 被 证 
明 是 难以 胜任 的 ， 这 是 因为 不 可 避免 的 建 模 误差 
和 不 确定 性 可 能 引起 接触 力 增 大 ， 并 最 终 导致 相 
互 作用 过 程 中 的 不 稳定 现象 ， 特 别 是 在 刚性 环境 
的 场合 中 。 机 器 人 系统 在 弱 结 构 化 环境 中 要 实现 
鲁 棒 和 通用 的 行为 ， 并 能 够 像 有 人 现场 操作 一 样 
安全 和 可 靠 ， 力 反馈 和 力 控制 是 不 可 或 缺 的 。 本 
章 首 先 分 析 了 问 接力 控制 策略 ， 该 策略 设想 通过 
确保 适当 的 末端 操作 器 的 柔顺 行为 来 保持 一 定 限 
度 的 接触 力 ， 而 不 需要 对 环境 的 精确 建 模 。 然 后 
分 析 了 交互 作业 的 建 模 问题 ， 考 虑 了 刚性 环境 和 
柔顺 环境 两 种 情况 。 对 于 交互 作业 的 规范 ， 相 
对 合适 的 作业 框架 ， 建 立 了 依据 作业 几何 设 定 
的 自然 约束 和 依据 控制 策略 设 定 的 人 为 约束 。 
这 种 公式 表示 是 综合 力 /运动 混合 控制 方案 的 基 
本 前 提 。 


7.1 背景 


AEH = AE, HAEA JI FE ll BY Ot SE E D 
展 。 如 此 广泛 关注 的 动机 ， 来 目 于 对 为 机 器 人 系统 提 
供 增强 的 感知 能 力 的 普遍 期 望 。 期 待 具 有力 、 触 觉 、 
距离 和 视觉 反馈 的 机 器 人 ， 能 在 不 同 于 典型 工业 和 车间 
场合 的 非 结构 化 环境 中 自主 操作 。 

在 遥 操 作 早 期 的 研究 工作 中 ， 就 设想 利用 力 反馈 
来 辅助 人 类 操作 者 使 用 从 机 械 手 来 远程 操作 物体 。 最 
近 开 发 的 协作 机 器 人 系统 中 ， 控 制 两 个 或 多 个 机 械 手 
( 即 灵巧 机 器 人 手 的 手指 ) 以 限制 其 相互 作用 力 和 避 
免 挤 压 共同 夹 持 的 物体 。 通 过 在 无 法 预料 情形 下 提供 
智能 响应 和 增强 人 -机 器 人 交互 ， 力 控制 对 于 在 开放 
环境 中 实现 机 器 人 系统 的 鲁 棒 和 通用 行为 也 发 挥 着 根 
本 性 的 作用 。 
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7.1.2 从 间接 力 控 制 到 力 / 运 动 混合 控制 ……… 131 
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7.1.1 从 运动 控制 到 交互 控制 


许多 实际 的 作业 需要 机 器 人 未 端 执 行 器 操作 一 个 
对 象 或 在 某 个 表面 上 执行 一 些 操作 。 对 于 这 些 作 业 的 
成 功 完成 ， 控 制 机 器 人 与 周围 环境 的 物理 接触 是 非常 
关键 的 。 工 业 生 产 中 的 典型 例子 包括 打磨 、 去 毛刺 、 
机 吉 工 或 装配 。 如 果 再 考虑 非 工业 应 用 ， 由 于 可 能 出 
现 的 状况 是 多 种 多 样 的 ， 因 此 对 可 能 的 机 器 人 作业 进 
行 完整 分 类 实际 上 是 不 可 行 的 。 而 且 这 样 的 分 类 对 于 
去 寻找 一 个 与 环境 交互 的 通用 控制 策略 也 并 不 是 真正 
有 用 的 。 

在 接触 过 程 中 ， 环 境 会 在 末端 执行 器 所 跟随 的 多 
何 路 径 上 设置 一 些 约束 ， 称 为 运动 学 约束 。 对 应 与 硬 
表面 接触 的 情况 通常 称 为 约束 运动 。 其 他 的 接触 作业 
情形 可 采用 机 器 人 与 环境 之 间 的 动态 交互 来 描述 ， 可 
以 是 惯性 的 〈 比 如 在 推 木 块 ) 、 耗 散 的 〈 比 如 在 有 摩 
擦 表面 滑动 ) 或 弹性 的 (比如 在 推 撞 一 个 弹性 柔顺 
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墙 面 ) 。 在 所 有 这 些 情 形 下 ， 使 用 单纯 的 运动 控制 策 
略 来 控制 交互 是 很 容易 失败 的 ， 下 面 将 进行 解释 。 

若 在 与 环境 交互 的 作业 中 采用 运动 控制 的 方法 ， 
只 有 作业 被 精确 地 规划 时 才能 成 功 执行 。 这 将 需要 机 
器 人 操作 手 〈 运 动 学 和 动力 学 ) 和 环境 (几何 和 机 
械 特性 ) 的 精确 模型 。 一 个 具有 足够 精度 的 机 械 手 
模型 可 以 得 到 ， 但 得 到 对 环境 的 详细 描述 却 是 非常 
难 的 。 

为 了 采用 定位 方法 完成 机 械 零 件 的 配合 ， 零 件 的 
相对 定位 精度 要 保证 比 零件 机 械 公 差 还 高 一 个 数量 
级 。 通 过 这 一 观察 就 足以 理解 作业 规划 精度 的 重要 性 
了 。 一 有 旦 已 经 准确 得 到 一 个 零件 的 绝对 位 置 ， 机 械 手 
就 应 该 以 同样 的 精度 操纵 其 他 零件 运动 。 

实际 上 ， 规 划 误 差 可 能 引起 接触 力 和 力矩 的 增 
大 ， 导 致 本 端 执行 器 偏离 期 望 轨迹 。 另 一 方面 ， 控 制 
系统 做 出 反应 来 减 小 这 种 偏离 。 这 最 终 使 接触 力 逐 渐 
增强 直到 关节 驱动 器 达到 饱和 或 零件 在 接触 部 位 发 生 
破裂 。 

越 高 的 环境 刚度 和 位 置 控制 精度 ， 越 容易 使 上 面 
描述 的 某 种 情况 发 生 。 如 果 在 相互 作用 过 程 中 保证 柔 
顺 行为 ， 就 可 以 克服 这 个 缺陷 。 和 柔顺 行为 可 以 被 动 或 
主动 方式 实现 。 

1. 被 动 交互 控制 

在 被 动 交互 控制 中 ， 由 于 机 器 人 固有 的 柔顺 ， 机 
器 人 末端 执行 器 的 轨迹 被 相互 作用 力 所 修正 。 柔 顺 可 
能 来 自 于 连 杆 、 关 节 和 末端 执行 器 的 结构 性 柔顺 ,或 
位 置 伺服 系统 的 柔顺 。 具 有 弹性 关节 或 连 杆 的 柔性 机 
器 人 手臂 就 是 为 了 与 人 固有 地 安全 交互 所 专门 设计 
的 。 在 工业 应 用 中 一 种 具有 被 动 柔顺 的 机 械 装置 已 被 
广泛 采用 ， 它 就 是 被 称 为 远 中 心 柔 顺 〈(RCC) 的 装 
BI) | RCC 是 一 个 安装 在 刚性 机 器 人 上 的 柔顺 末端 
执行 器 ， 专 门 为 轴 孔 装配 操作 所 设计 和 优化 。 

被 动 方法 的 交互 控制 是 非常 简单 和 廉价 的 ， 因 为 
它 不 需要 力 / 力 矩 传感器 ,并且 预 设 的 末端 执行 器 轨 
迹 在 执行 期 间 也 不 需要 改变 。 此 外 ， 被 动 柔 顺 结构 的 
响应 远 快 于 利用 计算 机 控制 算法 实现 的 主动 重 定位 。 
但 是 ， 由 于 对 每 个 机 器 人 作业 都 必须 设计 和 安装 一 个 
专用 的 柔顺 末端 执行 器 ， 因 此 在 工业 应 用 中 使 用 被 动 
柔顺 就 缺乏 灵活 性 。 它 也 只 能 处 理 程 序 设 定 轨迹 上 小 
的 位 置 和 姿态 偏离 。 最 后 ， 由 于 没有 力 的 测量 ， 它 也 
不 能 确保 很 大 的 接触 力 永 远 不 会 出 现 。 

2. 主动 交互 控制 

在 主动 交互 控制 中 ， 机 器 人 系统 的 柔顺 主要 通过 
特意 设计 的 控制 系统 来 获得 。 这 种 方法 通常 需要 测量 
接触 力 和 力 抵 ， 它 们 反馈 到 控制 器 中 用 于 修正 甚至 在 


线 生成 机 器 人 末端 执行 器 的 期 望 轨迹 。 

主动 交互 控制 可 以 克服 前 面 提 到 的 被 动 交 互 控制 
缺陷 ， 但 是 它 通 常 更 慢 、 更 昂贵 、 更 复杂 。 要 获得 合 
理 的 作业 执行 速度 和 抗 干扰 能 力 ， 主 动 交互 控制 需要 
与 一 定 程度 的 被 动 柔顺 联合 使 用 "2 。 从 定义 可 以 看 
出 ,反馈 只 能 在 运动 和 力 误差 发 生 后 才能 产生 ， 因 此 
需要 被 动 柔 顺 来 保持 反作用 力 低 于 一 个 可 以 接受 的 
{EL o 

3. 力 测量 

对 于 一 般 的 力 控 制作 业 ， 需 要 六 个 力 分 量 来 提供 
完整 的 接触 力 信息 ， 即 三 个 平移 力 分 量 和 三 个 力矩。 
通常 ， 力 /力矩 传感器 安装 在 机 器 人 腕 部 ”… 。 但 也 
有 例外 情况 ， 比 如 力 传感器 可 以 安装 在 机 器 人 手 的 指 
尖 上 1!74 ， 外 部 的 力 和 力矩 也 可 以 通过 关节 力矩 传 感 
器 对 轴 转 和 矩 的 测量 来 估计 :“ 。 但 是 ， 大 多 数 的 力 
控制 应 用 〈 包 括 于 业 应 用 ) 还 是 采用 胸部 力 / 力 矩 传 
感 器 。 在 这 种 情形 中 ， 通 常 假 设 安 装 在 传感器 与 环境 
之 间 的 工具 〈 即 机 器 人 末端 执行 器 ) 的 重量 和 惯性 
是 可 以 忽略 的 ， 或 者 是 可 以 从 力 / 力 矩 测量 中 适当 地 
补偿 。 力 信号 可 以 通过 应 变 的 测量 获得 ， 即 是 刚性 传 
感 器 。 或 者 通过 变形 的 测量 (比如 光学 方式 ) 来 获 
得 ， 即 是 柔顺 传感器 。 如 果 和 希望 增加 被 动 和 柔顺 ， 则 后 
面 一 种 方法 更 具 优 势 。 


7.1.2 从 间接 力 控 制 到 力 /运动 混合 控制 


主动 交互 控制 策略 可 以 分 为 两 种 类 型 ， 间 接力 控 
制 和 直接 力 控 制 。 两 种 类 型 之 间 的 主要 区 别 在 于 前 者 
没有 直接 的 力 反 馈 回 路 闭环 ， 通 过 运动 控制 来 实现 力 
控制 ; 而 后 者 由 于 具有 力 反 馈 回 路 闭环 ， 使 控制 接触 
力 和 力矩 达到 一 个 期 望 的 值 成 为 可 能 。 

第 一 种 类 型 属于 阻抗 控制 (或 导 纳 控制 ) ”“”， 
其 中 由 于 与 环境 相互 作用 会 导致 末端 执行 器 运动 对 于 
期 望 运动 产生 偏差 ， 这 种 偏差 被 认为 是 通过 带 可 调 参 
数 的 力学 阻抗 / 导 纳 而 与 接触 力 相 关 。 采 用 阻抗 (或 
导 纳 ) 控制 的 机 器 人 操作 手 可 以 使 用 一 个 具有 可 调 
参数 的 等 效 质量 - 弹 签 -阻尼 右 系 统 来 描述 。 如 果 机 唤 
人 控制 通过 产生 力 来 对 运动 偏差 作出 反应 ， 这 种 关系 
就 是 阻抗 。 而 如 果 机 器 人 控制 通过 施加 一 个 期 望 运动 
的 偏差 来 对 相互 作用 力作 出 反应 ， 就 相当 于 导 纳 。 阻 
抗 控制 和 导 纳 控制 的 特例 分 别 是 刚性 控制 和 麻 须 控 
制 “”， 这 里 只 考虑 了 末端 执行 器 对 于 期 望 运动 的 位 
置 和 姿态 偏差 与 接触 力 和 力矩 之 间 的 静态 关系 。 需 要 
注意 的 是 ， 在 机 器 人 控制 的 文献 中 ， 术 语 阻 抗 控制 和 
导 纳 控制 常常 用 来 指 同 一 控制 方案 ， 对 于 刚性 控制 和 
柔顺 控制 也 有 相同 的 情况 。 此 外 ， 如 果 仅 仅 关心 接触 
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力 和 力矩 与 末端 执行 器 的 线 速度 和 角速度 之 间 的 关 
系 ， 相 应 的 控制 方案 称 为 阻尼 控制 "9 。 

一 般 而 言 ， 间 接力 控制 方案 不 需要 测量 接触 力 和 
力矩 ， 得 到 的 阻抗 或 导 纳 往往 是 非 线 性 和 耦合 的 。 但 
是 ， 如 果 有 力 / 力 矩 传感器 可 用 ， 把 力 测量 值 用 于 控 
制 方案 中 就 能 得 到 线性 和 解 看 的 情况 。 

与 间接 力 控制 不 同 ， 直 接力 控制 需要 交互 作业 的 
显 式 模型 。 事 实 上 ， 使 用 者 必须 相对 于 环境 所 施加 的 
约束 ， 按 一 致 的 方式 指定 期 望 的 运动 和 期 望 的 接触 力 
和 力矩 。 一 个 在 该 类 别 中 被 广泛 采用 的 策略 是 力 / 运 
动 混合 控制 ， 它 的 目的 在 于 沿 着 非 约束 的 作业 方向 控 
制 运 动 和 沿 着 约束 的 作业 方向 控制 力 (和 力矩 )。 出 
发 点 是 考虑 对 于 许多 机 器 人 作业 ， 引 入 称 为 柔顺 坐标 
系 ” (REWERA) 的 正 交 参考 坐标 系 是 
可 行 的 ， 它 允 许 以 沿 着 和 围绕 该 坐标 系 的 三 个 正 交 轴 
作用 的 自然 约束 和 人 为 约束 的 形式 来 指定 作业 任务 。 
基于 这 样 的 分 解 ， 力 /运动 混合 控制 允许 同时 在 两 个 
互相 独立 的 子 空间 中 控制 接触 力 和 末端 执行 器 的 运 
动 。 对 于 平面 接触 表面 ""”] ， 作 用 于 期 望 量 和 反馈 量 
的 简单 选择 矩阵 可 用 来 满足 这 个 目标 。 然 而 ， 对 于 一 
般 的 接触 作业 ， 合 适 的 投影 矩阵 是 必须 使 用 的 ， 它 也 
可 以 由 显 式 约 束 方程 得 到 “ “2 。 可 以 提供 几 个 混合 
运动 控制 方案 的 实现 ， 比 如 在 操作 空间 的 基于 道 动力 
学 控制 “” 、 基 于 无 源 性 的 控制 "或 者 内 部 为 运动 
环 的 外 部 力 控 制 环 ， 这 通常 用 在 工业 机 器 人 中 中 ?1， 

如 果 不 能 获得 精确 的 环境 模型 ， 力 控制 作用 和 运 
动 控制 作用 可 以 被 羡 加 在 一 起 ， 得 到 的 就 是 并 行 力 / 
位 置 控制 方案 。 在 这 个 方法 中 ， 力 控制 器 被 设计 的 能 
够 支配 运动 控制 器 。 因 此 ， 为 了 确保 力 的 调整 ， 沿 着 
约束 的 作业 方向 的 位 置 误差 是 容许 的 。 


则 接力 控制 


为 了 深信 了 解 机 器 人 操作 手 的 未 端 执行 器 与 环境 
之 间 相 互 作用 时 所 出 现 的 问题 ， 有 必要 分 析 在 存在 接 
触 力 和 力矩 情况 下 运动 控制 策略 的 效果 。 为 此 ， 假 设 
有 一 个 参考 坐标 系 互 . 固 连 于 末端 执行 器 ， 并 将 原点 
的 位 置 矢量 记 为 忆 ， 相 对 固定 基 坐 标 系 的 旋转 抢 阵 
记 为 R.。 末 端 执行 器 的 速度 采用 6 x1 的 扭 矢 量 w = 
(p。w。) RRR, HP p .是 平移 速度 ，w. 是 角速度 。 


该 速度 可 以 由 n x1 关节 速度 矢量 4 ， 利 用 如 下 线性 
变换 计算 得 到 





7.2 


v, =J(q)q (7.1) 
AP, EEJ E 6 xn WRIT RJL EET LE 


为 简单 起 见 ， 只 考虑 非 元 余 非 奇异 机 械 手 的 情况 。 肉 
此 , nm=6， 并 且 雅 可 比 矩阵 是 一 个 非 奇 异 方 阵 。 未 端 
执行 器 作用 于 环境 的 力 SA om, fT RNE h, = 
fim") BS} 

有 必要 考虑 刚性 机 器 人 操作 手 在 与 环境 接触 情况 
下 的 操作 空间 动力 学 模型 公子 

Alg) v. +1 q,q)v,+n(q) =h,-h, (7.2) 
AH, 4(9) = (JH(q) J") -是 6x6 操作 空间 惯性 
矩阵 ，F(g，9) =I"C(q, @)J7' -A(q) dT BAY 
含 离心 力 和 科 氏 效应 的 力 螺旋 ,nm(g) =<I-"2(q) 是 
重力 效应 的 力 螺旋 , 则 H(g)、C(g, g) 和 g(g) 
年 在 关节 空间 里 所 定义 的 对 应 的 量 。 撩 量 疡 sot 
是 与 输入 关节 力矩 对 应 的 等 效 未 端 执行 器 力 螺 旋 . 


7.2.1 刚性 控制 


在 经 典 操作 空间 公式 中 ,末端 执行 器 的 位 置 和 姿 
态 由 6 x1 的 矢量 x, = (ple!) "来 描述 ， 其 中 Jo. 是 从 
R. 中 推算 出 的 一 组 欧 拉 角 。 因 此 ， 相 对 于 期 望 坐 标 
AD UE OE p, 和 旋转 矩阵 R, 末端 执行 器 的 
期 望 位 置 和 姿态 可 以 用 一 个 矢量 x, 来 表示 。 末 端 执 
行 带 的 误差 可 记 为 Ax, = xu -x。， 在 假设 x 为 常数 的 
情况 下 ， 对 应 的 速度 误差 可 表示 为 Ax, = - x, = 
-A7 (gq,)v,。， 这 里 

I 0 
ated = 人 0 re) 
AP, 7 是 3 x3 单位 矩阵 ; 0 是 3 x3 SM, TE 


关于 变换 w。 =T( 9.) 9.13 x3 和 矩阵， 取决 于 欧 拉 角 
的 具体 选择 。 

考虑 在 操作 空间 简单 PD + 重力 补偿 控制 所 对 应 
的 运动 控制 律 

h,=A Tp.) KpAX ge -Kpu + 4(q) 

AP, KeA KK, 是 对 称 正定 的 6x6 矩阵 。 

当 不 存在 与 环境 的 相互 作用 时 ( 即 当 有 ,=0 时 )， 
与 末端 执行 器 期 望 位 置 与 姿态 对 应 ， 闭 环 系统 的 平衡 
vy, =O, Av, =O 是 渐 近 稳定 的 。 稳 定性 判 据 是 基于 正 
定 李 雅 普 诺 夫 函数 


V= Al)n, + Ar, Ky Ar, 
它 沿 着 闭环 系统 轨迹 的 时 间 导 数 是 负 半 定 函 数 
V = -v Kv. (7.4) 
EEA ERE h 的 情况 下 ,使 用 类 似 的 李 雅 普 诺 


夫 判 据 可 以 得 到 一 个 不 同 的 具有 非 零 Axi. 的 渐 近 稳 
定 平衡 。 这 个 新 的 平衡 是 下 面 方程 的 解 


(7.3) 
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A (gw.)K,Ax,. —h, =0 


它 也 可 以 写成 如 下 形式 

Axa = Ks A (e.h, (7.5) 
或 者 等 价 地 写 为 

h, =4 (9, ) KpAx,, (7. 6) 


ct (7.6) 表明 在 稳定 状态 下 ， 比 例 控制 作用 于 位 置 
和 姿态 误差 ， 末 端 执行 器 表现 得 像 一 个 关于 外 部 力 和 
Hh AAA EAS, Ate, EE Ks 起 到 一 个 主 
动 刚性 的 作用 ， 这 意味 着 有 可 能 通过 调整 ,的 元 素 
来 确保 末端 执行 器 在 交互 作用 过 程 中 具有 适当 的 弹性 
表现 。 类 似 地 ， 式 (7.5) 表示 一 种 柔顺 关系 ， 其 中 
矩阵 K;! 起 到 主动 柔顺 的 作用 。 这 种 方法 设 定期 望 位 
置 和 姿态 以 及 末端 执行 器 相对 期 望 运动 的 位 置 和 姿态 
偏差 与 施加 于 环境 的 力 之 间 的 适当 静态 关系 ,被 称 为 
刚性 控制 。 

刚度 /柔顺 参数 的 选取 并 不 容易 ， 并 且 严 重地 依 
赖 于 所 执行 的 作业 。 主 动 刚性 的 值 越 大 意味 着 较 高 的 
位 置 控制 精度 是 以 更 大 的 交互 作用 力 为 代价 的 。 因 
此 ， 如 果 希 望 在 个 别 方向 上 满足 一 些 物 理 约束 ,末端 
执行 器 在 这 个 方向 上 的 刚度 就 要 表现 得 比较 低 以 确保 
较 小 的 交互 作用 力 。 反 之 , 沿 着 没有 物理 约束 的 方 
向 ， 末 端 执 行 器 的 刚度 则 应 该 表现 得 比较 高 以 便 精 确 
地 跟随 期 望 位 置 。 这 人 允许 不 用 过 大 的 接触 力 和 力矩 就 
能 解决 期 望 位 置 与 可 达到 的 位 置 之 间 的 偏差 ， 这 个 偏 
差 是 由 于 环境 所 施加 的 约束 导致 的 。 

但 是 ， 必 须 指出 的 是 ， 在 基于 式 (7.6) 的 实际 
应 用 中 不 能 有 效 地 设 定 沿 着 不 同方 向 选择 的 刚度 特 
性 。 对 由 一 个 六 自由 度 弹簧 所 连接 的 两 个 刚体 ， 从 以 
在 无 负荷 平衡 和 弹性 力 螺旋 两 种 情况 下 两 个 刚体 无 穷 
小 扭转 位 移 之 间 的 线性 变换 形式 表示 的 其 机 械 刚度 的 
经 典 定义 来 看 ， 就 能 很 容易 地 理解 这 个 问题 了 。 

在 主动 刚性 情况 下 ， 这 两 个 刚体 分 别 是 固 连 有 
坐标 系 工 ,的 末端 执行 器 和 固 连 有 期 望 坐标 系 之 .的 
虚拟 刚体 。 因 此 ， 在 如 下 定义 的 无 穷 小 扭转 位 移 情 


m F 
Sx.. = (Pe) = (OP la -(P*)a 
603. Aw. a. 

由 式 (7.6) 可 以 导出 如 下 的 变换 

h, =A (E) KA~ (pe)5ra (7.7) 
RP, AP a =P, -p AMARE APa = Pa -Ps 的 时 
间 导 数 ; Aw, =o - w. 是 角速度 误差 。 方程 (7.7) 
表明 实际 刚度 矩阵 是 4 T (p) KAT (p), ERR 
由 矢量 wo。 表 示 的 末端 执行 器 的 姿态 。 所 以 ， 在 实际 
应 用 中 选择 刚性 参数 是 非常 困难 的 。 





这 个 问题 可 以 通过 定义 一 个 具有 与 理想 机 械 弹 簧 
相同 的 结构 和 特性 的 几何 一 致 主动 刚性 来 解决 。 

1. 机 械 弹 簧 

考虑 两 个 弹性 看 合 的 刚体 4 和 B， 以 及 分 别 固 连 
于 4 和 B 上 两 个 参考 坐标 系 罗 ,和 区 ,。 假 设 在 平衡 
状态 时 坐标 系 工 .和 卫 , 是 重合 的 ， 平 衡 状 态 附 近 的 柔 
顺 特性 可 以 表示 为 线性 变换 
© Ky, 
a 
式 中 ,所 是 在 坐标 系 B 中 表示 的 作用 于 刚体 B 的 弹 
性 力 螺 旋 ， 出 现 于 坐标 系 王 .相对 坐标 系 工 ,存在 一 个 
无 穷 小 扭转 位 移 5x 的 情况 下 ， 该 位 移 也 是 在 坐标 系 
B 中 表示 的 。 由 于 允 。 和 区 ,在 平衡 状态 时 是 重合 的 ， 
所 以 式 (7.8) 中 的 弹性 力 螺旋 和 无 穷 小 扭转 位 移 也 
可 以 等 效 地 在 坐标 系 工 .中 表示 。 也 就 是 ，ia = 及 和 
dx’, =6x%。 此 外 ， 对 于 作用 于 刚体 4 上 的 弹性 力 螺 
旋 ， 由 于 âri = -AxA hi = K,6xi, = -ht。 变 换 
(7.8) 的 这 种 性 质 称 为 端 对 称 。 

fest (7.8) H, KÆ 6 x6 对 称 正 半 定 刚 度 矩 
阵 。3 x3 和 矩阵 天 和 于. 分 别称 为 平移 刚度 和 旋转 刚 
度 ， 也 是 对 称 的 。 可 以 看 出 ， 如 果 称 为 耦合 刚度 的 
3 x3 矩阵 天 .是 对 称 的 ， 旋 转 和 平移 之 间 有 最 大 程度 
的 解 耦 。 这 种 情况 下 ， 坐 标 系 王 ,和 开 \, 的 重合 原点 所 
对 应 的 点 称 为 刚度 中 心 。 对 于 沫 顺 矩阵 也 有 类 似 的 定 
义 和 结 果 的 表达 式 。 尤 其 是 ， 在 柔顺 矩阵 C = 的 
非 对 角 块 是 对 称 的 情况 下 可 以 定义 柔顺 中 心 。 刚 度 中 
心 和 和 柔顺 中 心 不 一 定 是 重合 的 。 

这 里 有 一 些 平移 和 旋转 之 间 不 存在 耦合 的 特殊 情 
况 ， 比 如 ， 刚 体 的 相对 平移 引起 一 个 沿 一 个 过 刚度 中 
心 轴 的 纯 力 所 对 应 的 力 螺旋 ， 还 有 刚体 的 相对 旋转 引 
起 一 个 等 价 于 绕 一 个 过 刚度 中 心 轴 的 纯 力矩 的 力 螺 
旋 。 在 这 些 情况 中 , 刚度 中 心 和 和 柔顺 中 心 相 重合 。 具 
有 完全 解 耦 特 性 的 机 械 系统 例子 有 比如 远 中 心 柔顺 
(RCC) 装置 。 

由 于 下 是 对 称 的， 在 平衡 状态 存在 相对 于 坐标 
RY =D ,的 旋转 矩阵 R,， 因 此 K, =RTR, JE 
及 是 一 个 对 角 阵 ， 其 对 角 元 素 是 旋转 矩阵 RK, 的 列 所 
对 应 方向 上 的 主 平移 刚度 ， 这 个 方向 称 为 平移 刚度 主 
轴 。 类 似 地 ，K, 可 以 表示 为 K, = RT,R。， 其 中 本 ,的 
对 角 元 素 是 绕 旋 转 和 矩阵 R, 的 列 所 对 应 轴 的 主 旋 转 刚 
度 ， 这 个 轴 称 为 旋转 刚度 主轴 。 此 外 ， 假 设 在 平衡 状 
态 玉 .和 克 , 的 原点 与 刚度 中 心 重合 ， 可 以 得 到 表达 式 
K. =R.IT.R'， 其 中 工 的 对 角 元 素 是 沿 旋 转 矩 阵 RR, 的 
Fil RTM A ERS UE, SO RAR AE 


hi = Kae’, =| (7.8) 
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主轴 。 总 而 言 之 ， 相 对 于 原点 为 刚度 中 心 的 坐标 系 ， 
6 x6 的 刚度 矩阵 可 以 根据 主 刚度 参数 和 主轴 来 设 定 。 

要 注意 的 是 式 (7.8) 所 定义 的 机 械 刚度 是 描述 
人 存 储 势 能 的 理想 六 自由 度 弹 簧 的 特性 。 理 想 刚 度 的 执 
能 函数 仅仅 取决 于 连接 的 两 个 刚体 的 相对 位 置 和 交 
态 ， 并 且 是 端 对 称 的 。 实 际 的 六 自由 度 弹簧 具有 与 理 
想 弹 簧 类 似 的 主要 特性 ， 但 仍然 总 是 具有 引起 能 量 耗 
散 的 寄生 效应 。 

2. 几何 一 致 主动 刚度 

为 了 实现 几何 一 致 的 六 自由 度 主动 刚度 ， 需 要 在 
控制 律 式 (7.3) 中 适当 地 定义 比例 控制 作用 。 在 理 
想 坐 标 系 ,相对 末端 执行 器 坐标 系 玉 ,存在 有 限 位 移 
的 情况 下 ， 这 个 控制 作用 可 以 表示 为 作用 在 末端 执行 
三 上 的 弹性 力 螺旋 。 因 此 ， 微 小 位 移 下 理想 机 械 刚度 
的 性 质 可 以 扩展 到 有 限 位 移 的 情况 。 此 外 ， 为 了 保证 
李 雅 普 诺 夫 意 义 上 的 渐 近 稳定 性 ， 必 须 定义 一 个 合 活 
的 弹性 势能 函数 。 

简单 起 见 ， 假 设 耦 合 刚度 矩阵 为 零 。 因 此 ， 可 以 
求 和 平移 势能 和 旋转 势能 来 计算 弹性 势能 。 

平移 势能 可 以 用 


Ki, = RKR! + SRK R 


定义 为 

V, =ApY.Kh Ap, 
AP, Rs 是 3 x3 对 称 正定 矩阵 。 在 式 〈7.9) 中 使 
用 Ks 代 蔡 Ks 保证 势能 在 有 限 位 移 情况 下 也 是 端 对 称 
的 。 在 平衡 状态 ( 即 R, = R. 时 ) 和 具有 各 向 同性 平 
RIBE (BI Ks = KmI 时) 的 情况 下 矩阵 KF Kp ft 
一 致 的 。 

计算 功 v 得 到 
,= ApS fi + Awm, 

AP, AP LEMEN Ap’, = RT(p, -p.) 的 时 间 导 
数 ; Aw), =R (a, —w,) « RE Sa M pes 分 别 是 在 存在 
有 限 位 置 位 移 Api. 情 况 下 作用 于 末端 执行 器 的 力 和 


力矩 。 当 在 基 坐 标 系 中 计算 时 ， 这 些 矢 量具 有 如 下 表 
达 式 


(7.9) 


fa = Kp, AD, may = Kt, Ap a (7.10) 
这 里 
pp 1 
Kp = S( Ap.) RaKa Ra 


其 中 , S (+) 是 计算 矢量 积 的 反对 称 算 子 。 矢 量 
hs = (fa mu) 是 在 存在 有 限 位 置 位 移 Ap, 和 零 旋 
转 位 移 情况 下 作用 在 末端 执行 器 上 的 弹性 力 螺旋 。 在 


具有 各 向 同性 平移 刚度 的 情况 下 力 夭 my, AX 

要 定义 旋转 势能 ， 必 须 对 坐标 系 闻 d 和 过 .之 间 的 
姿态 位 移 采 用 一 个 适当 的 定义 。 一 个 可 能 的 选择 是 从 
ABR Ry = ROR, HESS MY TEA inas e] 
的 失 量 部 分 。 因 此 ， 姿态 势能 具有 形式 

Vi =2 e Kye S, (7.11) 

式 中 , Kp, 3 x3 对 称 正定 矩阵 。 由 于 < 和 = 一 Ed， 
所 以 函数 凡是 端 对 称 的 。 


计算 功 了 _ 得 到 


V ,= oMa, 
其 中 
Mm, = Ki, E a (7.12) 
ix 
Kps = 2E" (na. 3 E de JR. Kp R: 
HAE (ne, Ex) =Mal-SCey)o LL EWREMA 
限 姿态 位 移 <s。 = R, ei 产生 一 个 与 纯 力 矩 等 效 的 弹 
性 力 螺旋 hh, = (0" mj)", 
因而 ， 在 期 望 坐标 系 互 , 相 对 末端 执行 器 坐标 系 
之 .存在 有 限 位 置 和 姿态 位 移 情 况 下 ， 整 个 弹性 力 螺 
旋 在 基 坐 标 系 中 可 定义 为 
h, =hy +h, (7.13) 
EP, ha 和 Ay, AIR (7.10) 和 式 (7.12) 
计算 。 
在 平衡 状态 附近 的 无 穷 小 扭转 位 移 Ox" 情况 下 ， 
使 用 式 (7.13) 来 计算 弹性 力 螺旋 ， 并 含 弃 高 阶 无 
穷 小 项 得 到 线性 变换 
kK, 0 
0 Ky 


内 此 ，& 表 示 理 想 弹 簧 相对 于 原点 在 刚度 中 心 的 坐 
你 系 互 (平衡 状态 下 与 互 , 重 合 ) 的 刚度 矩阵 。 此 外 ， 
由 式 (7.13) 的 定义 可 以 看 出 ， 在 大 位 移 情 况 下 所 
阵 Ks 和 Kb, 的 主 刚度 和 主轴 的 物理 /几何 意义 仍然 保 
持 不 变 。 

上 述 结果 意味 着 对 于 当前 的 作业 ， 主 动 刚度 矩阵 
K, 可 以 按 几何 一 致 的 方式 来 设置 。 

注意 到 儿 何 一 致 性 也 可 以 由 对 式 (7. 11) 姿态 
势能 中 姿态 误差 的 不 同 定义 来 保证 。 例 如 ， 可 以 采用 
任何 基于 Ri 的 角度 / 轴 表 示 的 误差 (单位 四 元 组 属于 
这 种 类型 ) ， 或 者 更 一 般 地 ， 采 用 齐 次 矩阵 或 指数 坐 
标 〈 对 于 具有 位 置 和 姿态 误差 的 情况 ) TH, HE 
阵 Ri 提取 得 到 的 XYZ 欧 拉 角 也 可 以 使 用 。 但 是 ,在 
这 种 情况 下 可 以 看 出 旋转 刚度 的 主轴 不 能 任意 地 设 
年 ， 而 是 必须 与 末端 执行 器 坐标 系 的 轴 重 合 。 

采用 几何 一 致 主动 刚度 的 柔顺 控制 可 以 使 用 如 下 


h. = K âx}, = | je (7. 14) 
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控制 律 来 定义 

h =h, —Kpv, +9(9@) 
这 里 使 用 的 是 式 (7.13) FH hao TEA, =0 时 平衡 
状态 的 渐 近 稳定 性 可 以 使 用 李 雅 普 诺 夫 函 数 来 证 明 


V= AC) ve +V, +V, 


这 里 的 六 和 ,分别 是 在 式 (7.9) 和 式 (7.11) 中 给 
出 的 ， 在 坐标 系 王 静止 的 情况 下 ， 它 们 沿 着 闭环 系 
统 轨 迹 的 时 间 导 数 具 有 与 式 〈7.4) 中 一 样 的 表达 
式 。 当 hh. 头 0 时 ， 对 应 于 期 望 坐标 系 王 ,相对 于 末端 
执行 器 坐标 系 了 工 .的 非 零 位 移 ， 可 以 得 到 不 同 的 痢 近 
稳定 平衡 。 这 个 新 的 平衡 是 方程 hs =h. KIHE 

通过 适当 选取 刚度 和 矩阵， 刚度 控 制 以 末端 执行 带 
的 位 置 和 姿态 误差 为 代价 ， 使 得 交互 作用 力 和 力矩 你 
持 在 有 限 范围 内 而 不 需要 力 / 力 矩 传感器 。 但 是 ,在 
出 现 能 够 建 模 为 等 效 末 端 执行 器 力 螺旋 的 扰动 〈 比 
如 关节 摩擦 ) 的 情况 下 ,采用 值 比较 低 的 主动 刚度 
可 能 导致 相对 于 末端 执行 器 期 望 位 置 和 姿态 的 较 大 侦 
差 。 在 没有 与 环境 相互 作用 时 也 会 出 现 这 种 情况 。 


7.2.2 阻抗 控制 


刚度 控制 是 设计 来 实现 交互 作用 时 的 理想 静态 特 
性 的 。 事 实 上 ， 控 制 系统 的 动态 特性 取决 于 机 髓 人 操 
作 手 的 动态 特性 ， 而 它 是 非 线性 和 耦合 的 。 一 个 要 求 
更 高 的 目标 可 能 是 实现 末端 执行 器 的 理想 动态 特性 。 
例如 ， 具 有 6 个 自由 度 的 二 阶 机 械 系 统 的 动态 特性 ， 
可 以 用 给 定 的 质量 、 阻 尼 和 刚度 来 描述 ， 称 为 机 械 
阻抗 。 

要 实现 这 个 目标 的 出 发 点 可 能 是 用 于 运动 控制 
的 分 解 加 速度 方法 ， 它 的 目的 是 利用 逆 动 力学 控制 
律 在 加 速度 层次 上 对 非 线性 的 机 器 人 动力 学 进行 解 
耦 和 线性 化 。 存 在 与 环境 的 相互 作用 情况 下 ， 将 控 
制 律 





h.=A(gq)a+T(g,9)gq +h, (7.15) 


代入 动力 学 模型 式 (7.2) 得 到 


vi, =a (7. 16) 
sth, a 是 一 个 相对 于 基 上 坐标 系 的 加 速度 意义 上 适当 


设计 的 控制 输入 。 考 虑 等 式 让 = RO wt Rul, 
这 里 


选取 


(7. 17 ) 


得 到 
v* =a’ (7. 18) 
式 中 ， 控 制 输入 a 具有 相对 于 末端 执行 器 坐标 系 的 


加 速度 的 意义 。 因 此 ， 设 定 


ae =K;' (v5 +K Avi +h hh) (7.19) 
对 于 闭环 系统 可 以 得 到 下 面 的 表达 式 
K, Av‘, +KpAvi, thi =h° (7.20) 


RH, Ky 和 Ky fz 6 x6 对 称 正定 矩阵 ; Avi = vi- 
vi; Avi, = 区 一 下; ud 和 天 分 别 是 期 望 坐标 系 王 的 
加 速度 和 速度 ; 居 是 弹性 力 螺 旋 。 这 里 所 有 的 量 都 
是 以 末端 执行 器 坐标 系 工 .为 参考 的 。 

上 面 描述 受 控制 的 末端 执行 器 的 动态 特性 的 方程 
可 以 看 做 是 推广 的 机 械 阻 抗 。 在 玉 =0 时 的 平衡 状态 
的 渐 近 稳定 性 可 以 通过 考虑 李 雅 普 诺 夫 函 数 来 证 明 


V = Avi, Ky Av + V, + V, 


Rp, VA VAER (7.9) 和 式 (7.11) 中 是 
义 ， 并 且 它 们 沿 系统 (7.20) 的 轨迹 的 时 间 寻 数 是 
负 半 和 定 函 数 


(7.21) 


V = -Avi Kb Av}, 

“4h AORT, SATARA D AT TR IT 
BRR DY MAES LB, TAAR IA AY 
稳定 平衡 。 这 个 新 的 平衡 是 方程 扑 = 有 的 解 。 

在 ,不 变 的 情况 下 ， 如 果 选 取 Kw 为 

(9 a 
0 M 

st (7.20) 具有 真正 六 自由 度 机 械 阻 抗 的 意义 ， 其 
中 ，m 是 质量 ,，M 是 3 x3 惯性 张 量 ，R 被 选取 作为 
具有 3 x3 块 的 对 角 分 块 矩阵 。 物 理 等 价 系 统 是 质量 为 
m 的 刚体 ， 具 有 相对 于 固 连 在 刚体 上 的 坐标 系 王 。 的 惯 
性 张 量 M， 并 受到 外 部 力 螺旋 hr 的 作用 。 这 个 刚体 
通过 一 个 具有 刚度 矩阵 K; 的 六 自由 度 理想 弹簧 与 一 
个 固 连 在 坐标 系 工 ,上 的 虚拟 刚体 相连 接 ， 还 受到 阻 
EH K HRADE. A (7.21) 中 的 函 
数 了 表示 刚体 的 总 能 ,动能 和 弹性 势能 的 和 。 

图 7.1 简略 给 出 了 阻抗 控制 的 框图 。 阻 抗 控制 基 
于 位 置 和 姿态 反馈 以 及 力 和 力矩 测量 ， 如 式 (7.17) 
和 式 (7.19) 中 那样 计算 加 速度 输入 。 然 后 ， 逆 动 
力学 控制 律 利 用 式 (7.15) 中 的 天 计算 关节 驱动 器 
keer = JP 。 在 没有 交互 作用 情况 下 ， 这 个 控制 方 
案 保 证 未 端 执行 器 坐标 系 工 . 渐 近 地 跟随 期 望 坐标 系 
X 。 在 与 环境 接触 的 情况 下 ， 按 照 阻抗 (7.20) 对 
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末端 执行 器 施加 有 柔顺 动态 特性 ， 并 日 以 LAY. Zl 
有 限 的 位 置 和 姿态 位 移 为 代价 使 接触 力 螺旋 有 界 。 与 
刚性 控制 不 同 ,用 于 测量 接触 力 和 力矩 的 力 /力矩 伟 
感 器 是 必需 的 。 





1. 实现 问题 

选择 好 的 阻抗 参数 以 获得 令 人 满意 的 特性 并 不 是 
一 件 容易 的 任务 。 事 实 上 ， 闭 环 系统 的 动态 特性 在 自 
由 空间 中 与 在 交互 作用 过 程 中 是 不 同 的 。 由 于 在 自由 
空间 中 必须 保证 运动 跟踪 和 扰动 抑制 ， 而 在 交互 作用 
过 程 中 主要 目标 是 实现 适当 的 末端 执行 器 柔顺 动态 特 
性 ,它们 的 控制 目标 也 是 不 同 的 。 还 要 注意 在 交互 作 
用 中 控制 系统 的 动态 取决 于 环境 的 动态 。 

为 了 深入 理解 这 些 问 题 ， 假 设 末 端 执 行 器 与 环境 
相互 作用 可 以 被 由 一 个 连接 末端 执行 器 坐标 系 L5 
环境 坐标 系 互 的 六 自由 度 理想 弹簧 所 得 到 的 作用 来 
近似 。 由 此 ， 根 据 式 (7.8), ED MDD FEES 
小 扭 位 移 的 情况 下 ,末端 执 行 器 作用 于 环境 的 弹性 力 
螺旋 可 以 计算 得 到 为 

ho = Kex (7.22) 
EP, EFORAE DAD MEA, K 是 刚度 矩阵 。 
ETT VR AL EEE YE FL FRS, MARKERI 
人 在 自由 空间 中 运动 时 接触 力 螺旋 为 零 。 

通过 在 机 器 人 操作 手动 态 模 型 (7.2) 的 右 侧 引 
和 一 个 对 应 于 作用 在 末端 执行 器 上 的 等 效 抗 动力 螺旋 
的 附加 项 ， 可 以 把 作用 于 机 器 人 操作 手 的 扰动 和 未 建 
模 动 态 (关节 摩擦 力 、 建 模 误 差 等 ) 考虑 进去 。 这 
个 附加 项 在 式 (7.18) 的 右 侧 产生 一 个 附加 加 速度 
扰动 y*。 因 此 ， 使 用 控制 律 式 (7.19)， 可 以 得 到 下 
面 的 闭环 阻抗 方程 

Ky Avi, +K,Av;, + 有 =h: + Key: (7.23) 
阻抗 参数 的 整定 过 程 可 以 从 线性 化 的 模型 开始 ， 
在 无 穷 小 位 移 情况 下 该 模型 可 以 由 式 (7.23) 计算 
得 到 ， 即 
Kv6x i + Kpt i + (Kp +K)8x%, = Kix’, + Kuy° 
(7.24) 


这 里 使 用 了 式 (7.22) 和 等 式 Oxo, = -Sr + 8X4, o 
AEE Fae (KO) 和 自由 运动 (K =0) 
都 是 成 立 的 。 

很 明显 ， 适当 的 位 置 和 姿态 误差 动态 可 以 通过 
适当 地 选取 增益 矩阵 Ky. K AK, Xi, TERA 
怎 阵 都 是 对 角 阵 的 假设 下 ， 使 无 穷 小 招 转 位 移 的 文 
个 分 量具 有 解 奈 性 质 ， 这 个 任务 是 很 容易 的 。 在 这 
种 情况 下 ， 每 个 分 量 的 瞬 变 特性 可 以 通过 使 用 关 
系 式 
kp +k 1 kp 
mm 
指定 固有 频率 和 阻尼 率 来 设 定 。 因 此 ， 如 果 选 取 的 
增益 在 相互 作用 (EEAO) 过 程 中 确保 获得 给 定 的 
加 有 频率 和 阻尼 率 ， 当 末 端 执行 器 在 自由 空间 【〈 即 
《=0) 中 运动 时 将 得 到 更 低 的 固有 频率 和 更 高 的 阳 
尼 率 。 至 于 稳 态 特性 ， 末 端 执 行 器 一 般 分 量 的 误 
差 为 





dx -一 + 
© (kp +k) ® "ky +k 

并 且 相 应 的 交互 作用 力 为 
kpk kyk 
ky th he eR? 
上 述 关 系 式 表 明 ， 在 相互 作用 过 程 中 ， 只 要 相对 于 环 
境 刚度 设 定 低 的 主动 刚度 ， 以 大 的 稳 态 位 置 误 差 
为 代价 就 可 以 使 接触 力 很 小 ， 反 之 亦 然 。 然 而 ， 接 解 
力 和 位 置 误差 又 都 取决 于 外 界 扰动 y。 尤 其 是 ，&, 越 
低 ，y 对 6xs。 和 两 者 的 影响 越 大 。 此 外 ， 在 没有 交 
互 作用 情况 下 ( 即 k=0 时 ) 低 的 主动 刚度 也 可 能 
导致 大 的 位 置 误差 。 

2， 导 纳 控 制 

这 个 问题 的 解决 方法 可 以 按 下 面 把 运动 控制 从 
阻抗 控制 中 分 离 出 来 的 方式 来 构想 。 运 动 控 制作 用 
特意 设 定 为 刚性 以 便 增 强 扰动 抑制 ， 来 确保 跟踪 由 
阻抗 控制 作用 得 到 参考 位 置 和 姿态 ， 而 不 是 保证 跟 
踪 末 端 执行 器 的 期 望 位 置 和 姿态 。 也 就 是 说 ， 期 望 
位 置 和 姿态 与 测量 的 接触 力 螺旋 一 起 输入 到 阻抗 方 
程 ， 通 过 适当 的 积分 产生 用 于 运动 控制 作为 参考 的 
位 置 和 姿态 。 

要 实现 这 个 解决 方法 ， 有 必要 引信 一 个 不 同 于 期 
望 坐标 系 王 * 的 参考 坐标 系 。 这 个 坐标 系 称 为 柔顺 坐 


ARE, Hit p。 Ra vA yw。 所 确定 ， 这 些 量 由 


Pax Ra, vA vs 以 及 测量 得 到 的 力 螺旋 hh. 通过 积 2 
下 面 方程 计算 得 到 
Ky Avi, +K Avi, +h’ =h, 





(7.25) 
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式 中 ,由 是 期 望 坐标 系 王 和 和 柔顺 坐标 系 三 之 间 存 在 
有 限 位 移 情况 下 的 弹性 力 螺旋 。 这 样 ， 就 得 到 了 一 个 
基于 道 动力 学 的 运动 控制 策略 ， 以 使 末端 执行 器 坐标 
系 允 ,与 柔顺 坐标 系 , 相 重合 。 为 了 保证 整个 系统 的 
稳定 性 ， 运 动 控制 器 的 带宽 应 该 高 于 阻抗 控制 器 的 


带宽 。 


Pa, Ra 






图 7.2 给 出 了 所 设计 的 控制 方案 的 框图 。 很 明 
B, RAH EEA, RIAA ,与 期 望 坐标 
系 工 重合 ， 并 且 位 置 与 姿态 误差 动态 和 扰动 抑制 能 
力 仅 取决 于 内 部 运动 控制 环 的 增益 。 男 一 方面 ， 存 在 
交互 作用 的 情况 下 ,动态 特性 受阻 抗 增益 (7.25) 
的 作用 影响 。 


sh 
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图 7.2 带 有 内 部 运动 控制 环 的 阻抗 控制 ( 导 纳 控制 ) 


由 于 在 式 (7.25) 中 ， 给 定期 望 坐标 系 的 运动 ， 
测量 的 力 〈 输 入 ) 用 于 计算 柔顺 坐标 系 的 运动 〈《 输 
出 ) ， 力 作为 输入 而 位 置 或 速度 作为 输出 的 变换 相当 
于 机 械 导 纳 ， 所 以 图 7. 2 中 的 控制 方案 也 称 为 导 纳 控 
制 。 反 之, 式 (7.20) 中 将 由 期 望 运动 轨迹 得 到 的 
末端 执行 器 位 移 (输入 ) 变换 到 接触 力 螺旋 〈 输 
出 ) ， 则 具有 机 械 阻 抗 的 意义 。 

3. 简化 方案 

逆 动 力学 控制 是 基于 模型 的 ， 并且 需要 修改 当前 
工业 机 器 人 控制 器 ， 控 制 器 通常 配备 有 具有 很 高 带宽 
的 独立 PI 关节 速度 控制 器 。 如 果 环 境 足 够 柔顺 ， 这 
些 控制 器 能 够 在 很 大 程度 上 解 耦 机 器 人 动力 学 ， 特 别 
是 在 慢 速 运动 情况 下 ， 来 减轻 外 部 作用 力 对 操作 了 手 的 
影响 。 因 此 ， 被 控制 机 器 人 的 闭环 动态 可 以 在 关节 空 
间 由 





q=4, 
来 近似 ， 或 者 在 操作 空间 等 价 为 
v. =D, (7. 26) 


其 中 g, 和 vw 是 由 适当 设计 的 外 控制 回路 所 产生 的 控 
制 信号 ， 用 于 内 部 速度 运动 控制 回路 。 这 些 控 制 信号 
之 间 的 关系 为 
g,=J (gq)v. 
对 应 于 分 解 速度 控制 ， 速 度 v, 可 以 按照 下 式 计算 
vi =v; + Ky! (ha —h:) 

式 中 ,控制 输入 是 以 末端 执行 器 坐标 系 为 参考 的 ; 
K, 是 一 个 6 x6 正定 矩阵 ; A ERA MERER K Ay 





性 力 螺旋 式 (7. 13)。 这 样 ， 相 对 应 由 阻尼 K, 和 刚度 
Ks 所 描述 的 末端 执行 器 的 柔顺 特性 ， 得 到 闭环 方 
程 为 

K, Av; +h, =h: 
在 Kb。 =0 情况 下 ， 得 到 的 方案 称 为 阻尼 控制 。 

作为 男 一 种 选择 ， 可 以 采用 导 纳 类 型 的 控制 方 

案 ， 这 里 柔顺 坐标 系 世 .的 运动 可 以 按照 位 置 p.、 姿 
AS RR. 和 速度 扭 矢量 六 ， 以 微分 方程 

K Avi, +ho = 天 
的 解 来 计算 ， 其 中 的 输入 是 期 望 坐标 系 王 ,的 运动 变 
量 和 接触 力 螺旋 h:。 然 后 , 区. 的 运动 变量 输入 到 内 部 
的 位 置 和 速度 控制 器 。 在 K。=0 情况 下 ， 得 到 的 方 
案 称 为 柔顺 控制 。 


7.3 交互 作业 


尽管 要 达到 满意 的 动态 特性 ， 控 制 参数 必须 针对 
单独 的 作业 任务 进行 整定 ， 但 间接 力 控制 不 需要 明确 
的 环境 知识 。 另 一 方面 ， 对 于 直接 力 控制 算法 的 合 
成 ， 一 个 交互 作业 的 模型 是 必须 的 。 

交互 作业 是 由 操作 手 与 环境 之 间 复 杂 的 接触 状 痪 
来 描述 的 。 要 保证 作业 正确 地 执行 ， 对 相互 作用 力 和 
力矩 的 解析 描述 是 必要 的 ， 从 建 模 的 角度 来 看 这 是 非 
常 苛刻 的 要 求 。 

实际 的 接触 状况 是 一 种 自然 地 分 布 的 现象 ， 涉 及 
接触 表面 的 局 部 特性 以 及 操作 手 与 环境 的 全 局 动态 。 
具体 为 : 
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1) 由 于 一 个 或 多 个 不 同类 型 的 接触 ， 环 境 对 末 
端 执行 器 运动 施加 运动 学 约束 ， 并 且 当 末端 执行 器 趋 
同 于 违反 约束 时 会 产生 反作用 力 螺旋 ， 例如， 机 器 人 
使 刚性 工具 在 无 摩 扩 刚 性 表面 上 滑动 。 

2) 在 存在 环境 动态 情况 下 ， 当 末端 执行 器 受到 
运动 学 约束 制约 时 ， 也 可 能 对 环境 施加 一 个 动态 力 螺 
旋 ， 例 如 ， 机 器 人 转动 曲柄 ， 与 曲柄 的 动态 是 有 关 
的 ， 或 者 机 器 人 推 挤 一 个 柔顺 表面 。 

3) 由 于 操作 手 的 关节 和 连 杆 ， 以 及 腕 部 力 / 力 
第 传感器 或 工具 的 有 限 刚 度 ， 接 触 力 螺旋 可 能 取决 于 
机 项 人 结构 性 柔顺 ， 例 如， 安装 在 RCC 装置 上 的 未 
MAITA o 

4) 在 相互 作用 过 程 中 接触 表面 可 能 产生 局 部 变 
形 ， 从 而 产生 分 散 的 接触 区 域 ， 例 如 ， 工 具 或 环境 的 
软 接触 表面 的 情况 。 

5) 在 非 理想 光滑 接触 表面 情况 下 ， 可 能 产生 静 
摩擦 和 动 摩擦。 

通常 在 简化 的 假设 下 进行 交互 控制 的 设计 和 性 能 
分 析 。 考 虑 下 面 两 种 情况 : 

1) 机 妖 人 和 环境 都 是 完全 刚性 的 ， 环 境 所 施加 
的 仅仅 是 运动 学 约束 。 

2) 机 器 人 是 完全 刚性 的 ， 系 统 中 所 有 的 柔顺 局 限 
于 环境 中 ， 并 且 接 触 力 螺 旋 可 以 由 线性 弹性 模型 近似 。 

在 这 两 种 情况 中 ， 都 是 假设 无 摩擦 接触 。 很 明显 
这 些 状况 都 只 是 理想 的 。 但 是 ， 控 制 的 鲁 棒 性 应 该 能 
够 处 理 一 些 对 理论 假设 放松 的 情况 。 在 那些 情况 下 ， 
控制 率 可 以 改变 以 适应 于 处 理 非 理想 的 特性 。 


7.3.1 刚性 环境 


环境 所 施加 的 运动 学 约束 可 以 由 一 组 方程 表示 ， 
方程 的 变量 描述 必须 满足 的 末端 执行 器 位 置 和 姿态 。 
由 于 通过 正 运动 学 方程 可 知 这 些 变 量 由 关节 变量 确 
定 ， 因 此 约束 方程 也 可 以 在 关节 空间 表示 为 
plq) =0 (7.27) 
HE ppmx WRB, Amen, Ep n 是 操作 手 
的 关节 数 ， 假设 是 非 元 余 的 。 不 是 一 般 性 ， 这 里 考虑 
n=6 的 情况 。 只 涉及 系统 广义 坐标 ， 形 如 (7.27) 
的 约束 称 为 完整 性 约束 。 形 如 plg, t) =0 的 时 变 约 
束 情 况 这 里 不 考虑 ， 但 也 可 以 采用 类 似 的 方法 分 析 。 
此 外 ， 仅 仅 关 注 形 如 (7.27) 等 式 所 表示 的 双 侧 约 
W: 这 意味 着 末端 执行 器 与 环境 一 直 保 持 接触 。 这 里 
给 出 的 分 析 称 为 动态 静 力 分 析 。 
假设 向 量 (7.27) 是 二 阶 可 微 ， 并 且 它 的 m 个 
分 量 至 少 在 操作 点 的 邻 域 是 局 部 地 线性 无 关 的 。 因 
IE, EK (7.27) 微分 ， 得 到 





J,(g)g =0 (7. 28) 
式 中 , (gq) = ag/aq Æ plq) 的 mx6 雅 可 比 和 矩阵 ， 
称 为 约束 雅 可 比 。 根 据 以 上 假设 ， 至 少 局 部 地 在 操作 
点 的 邻 域内 J,(q) 的 秩 为 m, 
不 考虑 摩擦 的 情况 下 ， 广 义 相互 作用 力 由 趋 于 违 
区 约束 的 反作用 力 螺 旋 来 表示 。 这 个 未 端 执行 器 力 螺 
旗 在 关节 上 产生 的 反作用 力矩 可 以 使 用 虚 功 原理 计 
算 为 
T.=J,(q)a 
式 中 , Ave mx] 的 拉 格 朋 日 乘 子 向 量 。 对 应 的 未 端 
执行 器 力 螺 旋 可 以 计算 为 
h.=J (gq)T.=S(g)A (7. 29) 
其 中 
Se= ig) J; Cq) (7. 30) 
从 式 (7.29) 可 以 得 出 hh. 属于 由 6 x m IME S 的 列 所 
张 成 的 m 维 向 量 空间 。 线 性 变换 (7.29) yay 


A=Si(q)h, (7. 31) 
AP, SERER 8 的 加 权 伪 道 ， 即 
Si = (S;WS,) STW (7. 32) 


AF, W 为 适当 的 加 权 和 矩阵 。 

注意 ， 尽 管 式 (7.30) 中 矩阵 8, 的 值 域 是 由 接 
触 的 几何 形状 唯一 定义 的 ， 和 矩阵 $, 自 身 却 不 是 唯一 
的 ; 并 且 约 束 方程 (7.27) 、 相 应 的 雅 可 比 和 矩阵 J 和 
伪 逆 St， 以 及 向 量 A 也 不 是 唯一 定义 的 。 

通常 ， 对 A 的 元 素 测量 的 物理 单位 不 是 同类 的 ， 
HRE SAIE RE Si 的 列 也 不 一 定 要 表示 同 质 的 实体 。 
这 可 能 在 变换 (7.31) 中 产生 不 变性 的 问题 。 如 果 
A. 表 示 一 个 受到 干扰 的 测量 的 力 螺旋 ， 作 为 结果 ， 可 
能 有 分 量 在 $; 的 值 域 范 围 之 外 。 如 果 物 理 单位 或 参 
BERRET, EE Si 要 进行 变换 ;但 是 带 有 恋 
换 的 伪 逆 的 式 (7.31) 的 结果 一 般 而 言 是 取决 于 所 
采用 的 物理 单位 或 取决 于 参考 坐标 系 。 原 因 在 于 伪 逆 
是 基于 向 量 h, -Si(g)A 的 范 数 的 最 小 化 问题 的 加 权 
最 小 二 乘 解 ， 并 且 只 有 使 用 这 个 向 量 的 物理 一 致 的 范 
数 才 能 保证 不 变性 。 在 h, TE $; 的 值 域内 的 理想 情况 
FP, 式 (7.31) 中 的 入 有 唯一 解 ， 并且 不 考虑 加 权 
和 矩阵， 这 样 就 不 会 出 现 不 变性 的 问题 。 

一 个 可 能 的 解决 方法 在 于 选取 以 使 它 自身 的 列表 
不 线性 无 关 的 力 螺旋 。 这 意味 着 式 (7.29) fi h R 
为 力 螺 旋 的 线性 组 合 ， 并且 是 无 量 纲 的 向 量 。 在 
力 螺旋 空间 物理 一 致 的 范 数 可 以 基于 二 次 型 ATK h, 
来 定义 ， 如 果 是 一 个 对 应 刚度 的 正定 和 矩阵， 其 具 
有 弹性 能 的 意义 。 因 此 ， 可 以 选取 W =K HER yt 
的 加 权 和 矩阵 。 
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注意 ， 对 于 给 定 的 $;,， 约 束 雅 可 比 可 以 由 式 
(7.30) 计算 为 J,(9q) =S Ja); 此外， 可 以 通过 积 
分 (7.28) 得 到 约束 方程 。 

使 用 式 (7.1) 和 式 (7.30)， 等 式 (7.28) 可 
以 重 写 形 为 


JOJ (DI) q =Sru=0 (7.33) 
根据 式 (7.29) 的 假设 ， 其 等 价 于 
h'v, =0 (7.34) 


式 (7.34) 表示 理想 反作用 力 螺 旋 RTIAI 
控制 子 空间 ) 和 服从 约束 的 末端 执行 器 扭 天 〈 属 于 
所 谓 的 速度 控制 子 空间 ) 之 间 的 动态 静 力 关系 ， 称 
为 互 反 性 。 在 刚性 和 无 摩擦 接触 的 假设 条 件 下 ， 互 反 
性 的 概念 表达 这 样 的 物理 事实 ， 即 力 螺旋 克服 扭 天 不 
做 任何 功 。 互 反 性 经 常会 与 正 交 性 的 概念 混 消 ， 由 于 
扭 撩 和 力 螺旋 属于 不 同 的 空间 ， 所 有 后 者 在 这 里 没有 
任何 意义 。 

式 (7.33) 和 式 (7.34) 意味 着 速度 控制 子 空 
间 是 m SE HE Hil FSS TB] A eb, a E RE E k 
定 。 因 此 ， 速 度 控 制 子 空间 的 维 数 是 6 —m, Ae 
义 一 个 6x (6-m) 的 矩阵 $,， 它 的 列 张 成 速度 控 
制 子 空间 ， 即 





v, =S,(q)p (7.35) 
Ap, 是 适当 的 (6-m) x1 的 向 量 。 由 式 (7.33) 
和 式 (7.35) 可 知 ， 下面 的 等 式 成 并 


S;(q)S,(q) =0 (7.36) 
此 外 ， 线 性 变换 (7.35) 的 逆 可 以 计算 为 
py =S)(q)v, (7. 37) 


sth, SiR RAE S Mik SH Mw, 与 式 
(7.32) 中 的 计算 一 样 。 

注意 ， 与 $, 的 情况 一 样 ， 尽 管 矩阵 $, 的 值 域 是 
唯一 定义 的 ， 和 矩阵 $, 自 身 的 选取 却 不 是 唯一 的 。 此 
外 ，S, 的 列 也 不 一 定 要 是 扭 拓 ,标量 v 也 可 以 具有 不 
同 种 的 物理 量 纲 。 但 是 ， 为 了 避免 类 似 于 Si 情况 中 
考虑 的 不 变性 问题 ， 可 以 简便 地 选择 S, 的 列 作为 扭 
矢 以 使 向 量 > 是 无 量 纲 的 。 此 外 ,， 式 〈7.37) 中 用 于 
A D E E AREN WM, mi Mi 
6 x6 的 惯性 矩阵 ， 这 相当 于 在 扭 矢 空间 基于 动能 定 
义 范 数 。 有 必要 注意 ， 对 应 参考 坐标 系 的 改变 ， 扭 天 
和 力 螺旋 的 变换 盾 阵 是 不 同 的 。 然 而 ， 如 果 扭 和 撩 定义 
为 角速度 在 上 平移 速度 在 下 ， 那 么 它们 的 变换 和 矩阵 和 
力 螺旋 是 一 样 的 。 

矩阵 S, 也 有 使 用 雅 可 比 的 表达 形式 , 与 式 
(7.30) 中 的 5S 一样 。 由 于 存在 mm 个 独立 几何 约束 
(7.27) ， 可 以 用 一 个 为 独立 变量 的 《6 - m) x1 HE 


E r 来 描述 与 环境 接触 时 机 器 人 的 构 型 。 根 据 隐 函数 
定理 ， 这 个 向 量 可 以 定义 为 

r=(q) (7. 38) 
式 中 , pla) 是 任意 (6 -—m) x1 WY Br Al i e et K 
数 ， 使 得 (gqg) 的 mm 个 分 量 和 yw(qg) 的 n-m 个 分 量 
至 少 在 操作 点 的 邻 域 是 局 部 地 线性 无 关 的 。 这 意味 着 
映射 (7.38) 与 约束 (7.27) 一 起 是 局 部 可 逆 的 ， 
它 的 逆 和 定义 为 

q=p(r) (7.39) 
sth, p(r) 是 6 x1 的 二 阶 可 微 向 量 肾 数 。 方 程 
(7.39) 显 式 地 给 出 了 所 有 满足 约束 (7.27) 的 关节 
向 量 。 此 外 ,满足 式 (7.28) 的 关节 速度 癌 量 可 以 
计算 为 

q=J,(r)r 
式 中 , J,(r) =dp/or 6x (6-—m) RHE RT EE 
阵 。 所 以 ， 下 面 的 等 式 成 立 

J,(a)J,(r) =0 

它 可 以 看 作 是 由 和 矩阵 J 的 列 所 张 成 的 反作用 力矩 子 
空间 与 由 矩阵 J 的 列 所 张 成 的 带 约 束 的 关节 速度 子 
空间 之 间 的 互 反 性 条 件 。 

重 写 上 面 的 方程 为 

IOIO J(q)J,(gq)=0 
并 把 式 (7.30) 和 式 (7.36) SRA, MM S 可 
以 表示 为 
S$, =J(q)J,(r) (7. 40) 
根据 式 (7.38) 和 式 (7.39)， 可 以 等 价 地 表示 为 4 
或 r 的 函数 。 

FERE S.A S LAR ETA Oa SIA SBR APE 
阵 。 它 们 除了 在 控制 综合 中 ， 在 作业 规范 中 也 起 着 重 
要 作用 ， 即 期 望 的 末端 执行 器 的 运动 和 相互 作用 力 与 
力矩 的 规范 。 


柔顺 环境 


在 很 多 应 用 中 ， 末 端 执行 器 与 柔顺 环境 之 间 的 相 
互 作用 力 螺 旋 可 以 使 用 形 如 (7.22) 的 理想 弹性 模 
型 来 近似 。 但 是 ， 由 于 刚度 矩阵 六 是 正定 的 ， 当 环 
境 变 形 与 未 端 执 行 器 无 穷 小 扭转 位 移 重合 时 ， 这 个 模 
型 描述 的 是 完全 约束 的 情况 。 但 是 ， 一 般 来 说 末端 执 
行 器 的 运动 只 是 受到 环境 的 部 分 约束 ， 这 种 情况 可 以 
通过 引入 合适 的 半 正 定 刚度 矩阵 来 建 模 。 

可 以 通过 将 环境 建 模 为 一 对 刚体 S 和 0， 并 由 一 
A Ny C = 天 一 的 理想 六 自由 度 弹簧 连接 ， 来 计算 
描述 未 端 执 行 器 与 环境 之 间 部 分 约束 的 相互 作用 的 刚 
度 和 矩阵 。 刚 体 S 与 坐标 系 DE, HRT Ae 


7.3.2 
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接触 ; 刚体 0 SARK AD AE, MAREE 
状态 与 坐标 系 王 重合 。 存 在 力 螺旋 hs 的 情况 下 ， 环 
境 在 平衡 状态 附近 的 变形 可 以 由 坐标 系 光 ;和 区 ,之 间 
的 无 穷 小 扭转 位 移 5xso 来 表示 ， 其 可 以 计算 为 
8X5 = Ch, (7.41) 
为 了 简便 起 见 ， Ja AT A BAG A RD BS E 
上 标 So 
对 于 所 考虑 的 接触 状况 ， 因 为 环境 可 以 变形 ,未 
端 执 行 器 的 扭 矢 不 是 完全 属于 对 应 于 刚性 环境 的 理想 
速度 子 空间 。 因 此 ,末端 执 行 器 坐标 系 王 .相对 于 
Zo 的 无 穷 小 扭转 位 移 可 以 分 解 为 
ôx., = Ax, + x, (7. 42) 
AF, dx, ER Shin fh AT ae LE BR BE Fe tll T E E AS TF 7) 
扭转 位 移 ， 定 义 为 力 控制 子 空间 的 6 -m 维 互 反 补 ， 
而 &x; 则 是 对 应 于 环境 变形 的 末端 执行 器 的 无 穷 小 捏 
转 位 移 。 因 此 : 
dx, = P,dx,, (7.43) 
dx, = (I ~-P,)dx,,=(1-P,)dx,, (7.44) 
式 中 ,已 , =$,$,、S$, 和 8$;, 是 与 在 刚性 环境 情况 下 一 样 
定义 的 。 和 矩阵 已 是 滤 除 所 有 不 在 $, 值 域内 的 末端 执 
Tes (ADA DARE) 的 投影 矩阵 ， 而 
I- P ERRIA E $, 值 域内 的 末端 执行 器 的 扭 矢 
(和 无 穷 小 扭转 位 移 ) 的 投影 矩阵 。 扭 矢 P,v 表示 自 
BEHR, MHAR (I -已 ,)v 表 示 约 束 扭 矢 。 
在 无 摩擦 接触 假设 条 件 下 ， 和 刚性 环境 情况 下 一 
样 ， 末 端 执行 器 与 环境 之 间 的 相互 作用 力 螺 旋 被 局 限 
于 由 和 矩阵 S H m 维 值 域 所 定义 的 力 控 制 子 空间 
A, Bp 
h, =S,A=h, (7.45) 
式 中 ,A 是 mx1 的 无 量 纲 向 量 。 式 (7.42) 的 两 边 
BER S, HAMAR (7.41)、 式 (7.43)、 式 
(7.44) 和 式 (7.45) 得 到 
S âx., =S;CS,A 
这 里 利用 了 等 式 SfP, =0。 因 此 ， 可 以 得 到 如 下 的 弹 
性 模型 : 
h, =S,A = K'&x,, (7.46) 
AP, K'=S,(S'CS,) S 是 半 正 定 的 刚度 和 矩阵， 对 
应 于 部 分 约束 的 交互 。 
如 果 采 用 柔顺 矩阵 C 作为 计算 Si 的 加 权 和 矩阵 ， 
则 K' 可 以 表示 为 
K' =P.K (7.47) 
式 中 ，P, = SiSi 是 滤 除 不 在 $; 的 值 域内 的 所 有 未 端 执 
行 器 的 力 螺旋 的 投影 矩阵 。 
因为 用 于 部 分 约束 交互 的 柔顺 矩阵 的 秩 m < 6， 


所 以 这 个 矩阵 不 能 计算 作为 K' 的 逆 。 但 是 ， 利 用 式 
(7.44)、 武 (7.41) 和 式 (7.45)， 可 以 得 到 下 面 的 
等 式 
Br =C'h, 

其 中 和 矩阵 

GC ead oO (7. 48 ) 
是 秩 为 6 - 兽 的 半 正 定 抢 阵 。 如 果 采 用 刚度 和 抢 阵 关 作 
为 计算 S ROTA RE, WER C' 具 有 值得 注意 的 表 
达 式 C =C-S, (SKS) S, RIH C' 是 对 称 的 。 


7.3.3 作业 规范 


交互 作业 可 以 利用 期 望 的 末端 执行 器 力 螺旋 ha 
MARE 内 来 指定 。 为 了 与 约束 一 致 ， 这 些 向 量 必 
须 分 别 属于 力 控制 和 速度 控制 子 空间 。 这 可 以 通过 指 
定向 量 各 和 vw 来 保证 ， 并 计算 hy A vy 

h,=S,A,, vy =S, va 

式 中 ，St 和 ,必须 在 作业 几何 的 基础 上 适当 地 定义 ， 
以 保证 考虑 到 选取 参考 坐标 系 和 改变 物理 单位 的 不 

很 多 机 器 人 作业 具有 一 组 正 交 参考 坐标 系 ， 在 这 
些 坐标 系 里 作业 规范 是 非常 容易 和 直观 的 。 这 样 的 坐 
标 系 称 为 作业 坐标 系 或 柔顺 坐标 系 。 交 互 作 业 可 以 通 
过 设 定 沿 / 绕 着 每 个 坐标 系 轴 的 期 望 力 /力矩 或 期 望 
线 /角速度 来 指定 。 由 于 这 些 期 望 的 量 是 由 控制 器 所 
施加 ， 所 以 称 之 为 人 为 约束 ; 在 刚性 接触 情况 下 ， 这 
些 约束 是 那些 由 环境 施加 并 称 为 目 然 约 束 的 补充 。 

下 面 给 出 一 些 作 业 坐 标 系 定义 和 作业 规范 的 
例子 。 

1. 销 孔 装配 

这 个 作业 的 目的 是 把 销 推 人 到 孔 中 ， 同 时 避免 攀 紧 
和 卡 阻 现象 。 销 具有 两 个 运动 目 由 度 ， 因 此 速度 控制 子 
空间 的 维 数 是 6 -m=2， 而 力 控 制 子 空间 的 维 数 是 m = 
4。 作 业 坐 标 系 可 以 如 图 7. 3 中 所 示 那 样 选取 ， 并 通过 指 
定 下 面 的 期 望 力 和 力矩 以 及 期 望 的 速度 来 完成 作业 








图 7.3 圆柱 销 插入 到 孔 中 


1) RR x Al y PES 

2) 56x, All y RARE 

期 望 速度 : 

1) 沿 着 za 轴 的 非 零 线 速度 。 

2) 绕 z 轴 的 任意 角速度 。 
作业 持续 直到 在 zx 方向 测量 到 很 大 的 反作用 力 ， 表 明 
销 已 经 碰 到 和 孔 的 底部 ， 这 在 图 中 没有 表示 出 来 。 因 
IE, FARE SA $, 可 以 选取 为 


1 0 0 0 0 0 

0 1 0 0 0 0 

0000 1 0 
S; = > S, = 

0 0 1 0 0 0 

00 0 1 0 0 

0 0 0 0 0 1 


式 中 ，S; 的 列 具 有 力 螺旋 的 维 数 ，$, 的 列 上 共有 扭 矢 的 
维 数 ， 如 作业 坐标 系 中 所 定义 的 。 当 参考 坐标 系 改变 
时 ， 它 们 相应 地 变换 。 作 业 坐 标 系 既 可 以 选择 固 连 于 
末端 执行 嚣 ， 也 可 以 固 连 于 环境 。 

2. 旋转 曲柄 

这 个 作业 的 目的 是 旋转 具有 自由 转动 手柄 的 曲柄 。 
手柄 具有 两 个 运动 自由 度 ， 对 应 于 绕 z, 轴 的 转动 和 绕 曲 
柄 转轴 的 转动 。 因 此 速度 控制 子 空间 的 维 数 是 6 -m =2, 
而 力 控制 子 空 间 的 维 数 是 到 =4。 作 业 坐 标 系 可 以 如 
图 7.4 中 所 示 那 样 选 取 ， 固 连 于 曲柄 。 





图 7.4 旋转 具有 空转 手柄 的 曲柄 


通过 指定 下 面 的 期 望 力 和 力矩 以 及 期 望 的 速度 来 
完成 作业 : 

1) 沿 着 x. 和 z 轴 的 零 力 。 

2) Six, Al y MEJE. 

期 望 速度 : 

1) 沿 着 y. 轴 的 非 零 线 速 度 。 

2) 绕 z, 轴 的 任意 角速度 。 
Alt, Bete AmA, OE St 和 5S, 可 以 选取 为 
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100 0 0 0 
000 0 1 0 
0100 0 0 
Si = , S,= 
001 0 0 0 
000 1 0 0 
000 0 0 1 


在 这 种 情况 下 ， 作 业 坐 标 系 相 对 于 曲柄 是 固定 的 ， 
但 相对 于 末端 执行 器 坐标 系 〈 固 定 于 手柄 ) 和 机 
证 人 基 坐 标 系 都 是 运动 的 。 因 此 ， 当 参考 末端 执 
行 咒 坐标 系 或 者 基 坐 标 系 时 ， 惩 阵 S A S, ARE 
变 的 。 

3. 在 平面 弹性 表面 上 滑动 方块 

这 个 作业 的 目的 是 在 平面 表面 上 沿 着 x, 轴 滑动 
一 个 方块 ， 同 时 用 一 个 作用 于 弹性 平面 表面 的 给 定 
力 推 它 。 物 体 具 有 3 个 运动 自由 度 ， 因 此 速度 控制 
子 空间 的 维 数 是 6 -m=3， 而 力 控制 子 空间 的 维 数 
是 m=3。 作 业 坐 标 系 可 以 选取 固 连 于 环境 ， 如 图 
7.5 中 所 未。 





图 7.5 在 平面 弹性 表面 上 滑动 块 状 物体 


通过 指定 期 望 速度 以 及 期 望 力 和 力矩 来 完成 
作业 : 

1) 沿 着 %, 轴 的 非 零 速 度 。 

2) 沿 着 7y, 轴 的 零 速 度 。 

3) 绕 z 轴 的 零 角速度 。 

AJAJE: 

1) 沿 着 z, 轴 的 非 零 力 。 

2) 绕 x, 和 yy, 轴 的 零 力矩 。 
因此 ,和 矩阵 St 和 5S, 可 以 选取 为 


0 0 0 1 0 0 

0 0 0 0 1 0 

1 0 0 0 0 0 
S,= S, = 

0 1 0 0 0 0 

0 0 1 0 0 0 

0 0 0 0 0 1 


6 x6 的 刚度 矩阵 K' 对 应 于 末端 执行 器 与 环境 之 间 部 
分 约束 的 相互 作用 ， 除 了 3 x 3 主子 式 K. 的 元 素 ， 
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天 的 元 素 都 是 零 。 主 子 式 由 天 的 第 3、4、5 行 和 第 
3.4, 5 列 构成 ， 可 以 表示 为 


式 中 ，c =6,; 是 柔顺 矩阵 C 的 元 素 。 

4. 一 般 接触 模型 

对 于 各 种 实际 机 器 人 作业 的 规范 ， 作 业 坐 标 系 的 
概念 被 证 明 是 非常 有 用 的 。 但 是 ， 它 只 适用 于 那些 复 
杂 度 有 限 的 作业 几何 ， 并 且 其 分 离 的 控制 模式 可 以 独 
立地 分 配 到 沿 着 单个 坐标 系 的 轴 的 3 个 纯 平移 和 3 个 
纯 转动 方向 。 对 于 更 复杂 的 状况 ， 比 如 多 点 接触 的 情 
况 ， 作 业 坐 标 系 就 不 存在 了 ， 必 须 采 用 更 为 复杂 的 模 
型 。 一 个 合适 的 解决 方法 是 使 用 虚拟 接触 操作 手 模 
型 ， 其 中 使 用 一 个 被 操作 物体 与 环境 之 间 的 虚拟 运动 
学 链 来 建 模 每 个 单独 的 接触 ， 并 且 当 接触 时 赋予 被 操 
作物 体 (瞬时 地 ) 相同 的 运动 自由 度 。 所 有 单独 接 
触 的 虚拟 操作 手 形成 了 并 行 操作 手 ， 其 速度 和 力 运动 
学 方程 可 以 利用 真实 操作 手 的 标准 运动 学 方程 步骤 得 
到 ， 并 且 人 允许 构建 所 有 运动 约束 的 扭 矢量 和 力 螺旋 空 
间 的 基 。 

一 个 更 为 一 般 的 方法 ， 称 为 基于 约束 的 作业 规 
范 。 它 开发 了 涉及 复杂 几何 和 /或 多 传感器 ( 力 / 力 
矩 、 距 离 、 视 觉 传 感 器 ) 的 使 用 的 新 应 用 ， 用 于 同 
时 控制 空间 中 的 不 同方 向 。 作 业 坐 标 系 的 概念 扩展 
到 多 个 特征 坐标 系 。 每 个 特征 坐标 系 可 以 使 用 沿 着 
坐标 系 轴 的 平移 和 转动 方向 来 对 作业 几何 的 一 部 分 
进行 建 模 ; 约束 的 一 部 分 也 可 以 在 每 个 特征 坐标 系 
中 指定 。 通 过 合并 在 每 个 在 单独 特征 坐标 系 中 表示 
的 部 分 的 作业 和 约束 规范 ， 可 以 得 到 总 的 模型 和 总 
的 约束 集合 。 


7.3.4 基于 传感器 的 接触 模型 估计 


在 假设 精确 的 接触 模型 是 一 直 可 以 得 到 的 条 件 
下 ， 作 业 规 范 取决 于 对 速度 控制 子 空间 和 力 控 制 子 空 
间 的 定义 。 另 一 方面 ， 在 大 多 数 实 际 执行 中 ， 选 择 矩 
阵 S, 和 $, 并 不 是 已 知 的 。 但 是 许多 交互 控制 策略 是 
相当 鲁 棒 的 ， 可 以 克服 建 模 误 差 。 事 实 上 ， 可 靠 地 处 
理 这 些 状况 正 是 使 用 力 控制 的 原因 。 在 作业 执行 过 程 
中 ， 如 果 和 矩阵 SAN $, 可 以 使 用 运动 和 /或 力 测 量 来 连 
续 更 新 ， 力 控制 器 的 鲁 棒 性 就 会 提高 。 

具体 来 说 ， 假 设 一 个 名 义 模型 是 可 以 得 到 的 。 当 
接触 状况 进展 不 同 于 模型 所 预测 的 那样 ， 测 量 的 运动 
和 力 开 始 与 预测 的 偏离 。 这 些小 的 不 一 致 可 以 被 测量 


并 用 于 在 线 调整 模型 ， 所 使 用 的 算法 可 以 由 像 卡 尔 曼 
滤波 这 样 的 经 典 状 态 -空间 预测 -校正 佑 计 得 到 。 

图 7.6 给 出 了 一 个 名 义 的 运动 和 力 变 量 与 测量 的 
运动 和 力 变量 之 间 误 差 的 例子 ,这 是 二 维 轮 廓 跟踪 作 
业 的 典型 情况 。 如 果 环 境 不 是 平面 ， 接 触 法 向 的 姿态 
会 改变 。 因 此 ， 在 名 义 接 触 法 向 和 实际 接触 法 向 之 间 
出 现 了 一 个 角度 误差 g。 名 义 接 触 法 向 对 齐 到 作业 坐 
标 系 《 轴 为 和 % 的 坐标 系 ) 的 % 轴 ， 而 实际 接触 法 
加 对齐 到 实际 作业 坐标 系 〈 轴 为 x, 和 7y, 的 坐标 系 ) 
的 y, 轴 。 这 个 角度 可 以 只 通过 速度 或 力 的 测量 来 
估计 。 





图 7.6 姿态 误差 的 估计 
a) 基于 速度 的 方法 b) 基于 力 的 方法 


1) 基于 速度 的 方法 : 实际 执行 的 线性 速度 与 
实际 轮廓 (对 齐 到 x RH) AA, MARSA x, 
轴 ， 有 一 个 小 的 分 量 沿 着 7 轴 。 于 是 姿态 误差 9 可 以 
HH @=tan™'(v,/v,,) 来 近似 。 

2) 基于 力 的 方法 : 测量 的 (理想 的 ) 接触 力 f 
不 是 完全 沿 着 名 义 法 向 方向 对 齐 到 7, 轴 ， 而 是 沿 着 x 
轴 有 一 个 小 的 分 量 f。 于 是 姿态 误差 9 可 以 由 08= 
tan”! (f/f,) 来 近似 。 

基于 速度 的 方法 会 受到 系统 机 械 柔 顺 的 干扰 ;， 基 
于 力 的 方法 会 受到 接触 摩擦 的 干扰 。 


7.4 力 /运动 混合 控制 


力 /运动 混合 控制 的 昌 的 是 将 对 末端 执行 器 运动 
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和 接触 力 的 同时 控制 分 成 两 个 解 看 的 单独 子 问题 。 在 
接 下 来 的 部 分 ， 对 刚性 环境 和 有 柔顺 环境 两 种 情况 ， 给 
出 了 混合 框架 下 的 主要 控制 方法 。 


7.4.1 分 解 加 速度 方法 


与 运动 控制 情况 一 样 ， 分 解 加 速度 方法 的 用 的 是 
通过 逆 动 力学 控制 律 ， 在 加 速度 层次 对 非 线 性 的 机 器 
人 动力 学 进行 解 看 和 线性 化 。 在 与 环境 存在 相互 作用 
的 情况 下 ， 寻 找 力 控制 子 空间 和 速度 控制 子 空间 之 间 
的 完全 解 耦 。 基 本 的 想法 是 设计 一 个 基于 模型 的 内 控 
制 环 来 补偿 机 器 人 操作 手 的 非 线性 动态 以 及 解 簿 力 和 
速度 子 空间 ; 然后 设计 一 个 外 控制 环 来 保证 扰动 抑制 
和 末端 执行 器 期 望 力 与 运动 的 跟 踊 。 

1. 刚性 环境 

对 于 刚性 环境 ， 外 部 力 螺旋 可 以 写成 h. = S.A 的 


形式 。 通 过 求解 式 (7.2) 得 到 v。 并 将 其 代入 到 式 
(7.33) 的 后 一 个 等 式 的 时 间 导 数 中 ， 可 以 从 去 
(7.2) 中 消去 力 乘 子 A。 这 样 可 以 得 到 : 


A=A(qg) {SA gh. -ulg 4) ] + StH, | 
(7.49) 


AHR, A,(q) =(S'A S) 和 (gq, q ) =I'q + Fc 
因此 ， 约 束 动态 可 以 重 写 为 


Alg) v. +S,A,(q) Sty, =P(q) lh. -pl(q,9)] 
(7. 50) 

Rh, P=1-S,A,S|A7'. TER, PS,=0, Ain 6 x6 
的 矩阵 了 RIERA ES, A ERS BYR ATT tt 
螺旋 的 投影 矩阵 。 它 们 对 应 于 那些 趋 于 违反 约束 的 力 
螺旋 。 

st (7.49) 说 明 力 乘 子 向 量 入 也 瞬时 地 取决 于 
施加 的 输入 力 螺旋 h.。 因 此 ， 通 过 适当 选取 h.， 有 
可 能 直接 控制 那些 趋 于 违反 约束 的 力 螺旋 的 m 个 独 
立 分 量 ， 这 些 分 量 可 以 利用 式 (7.29) dm SHR 
子 计 算得 到 。 另 一 方面 , R (7.50) 表示 的 一 组 6 
个 二 阶 微分 方程 ， 如 果 初 始 化 到 约束 上 ， 则 方程 的 解 
一 直 自 动 地 满足 式 (7.27)。 

约束 系统 的 降 阶 动态 特性 可 由 6 -mm 个 二 阶 方程 
描述 ， 这 些 方 程 通过 在 式 (7.50) P AR Ze R HE 
St 并 利用 








v, =S,p + Sv 
替换 加 速度 v. 得 到 。 最 后 得 到 方程 为 


A.(q)¥ +S A (a) Sty, -STR -p(g,94) -AS w] 
(7.51) 


这 里 利用 了 A, =STAS,, xt (7.36) RISP =S, W 
外 ， 表 达 式 (7.49) 可 以 重 写 为 

A=A,(q)S'A“'(q) A, -Ag 2) -AC Suv] 
这 里 利用 了 等 式 STS, = -S'S,。 

通过 选取 控制 力 螺 旋 hh. 如 下 ， 可 以 设计 一 个 逆 
动力 学 内 控制 环 

h, =A(q)S,a,+5,f, +4(9,9) +A(q) Sy 

(7. 52) 


式 中 ，a, 和 及 是 适当 设计 的 控制 输 人 。 
把 式 (7.52) 代入 到 式 (7.51) AA (7.49) 


v = 
A=f, 
表明 控制 律 (7.52) 能 使 力 控制 和 速度 控制 子 空间 
之 间 完 全 解 耦 。 
值得 注意 的 是 ,假如 矩阵 SA 5, 已 知 或 在 线 估 
ib, 对 于 控制 律 (7.52) 的 执行 ， 定义 用 于 约束 系 
统 的 构 型 变量 向 量 的 约束 (7.27) 和 (7.38) 是 不 
需要 的 。 在 这 些 情况 中 ,通过 用 向 量 As(i) 指定 期 
tA AA y(t) 指定 期 望 速度 ， 可 以 很 容易 地 
分 配 作业 任务 ; 而 且 ， 实 现 了 力 /速度 控制 。 
WAH A(t) 可 以 通过 设 定 
fi =A (t) (7.53) 
获得 ， 但 是 由 于 它 不 包含 力 反 馈 ， 这 样 选取 对 干扰 力 
非常 敏感 。 另 外 可 以 替代 的 选取 为 
fi =A) + Kp LA (t) -A(t) | (7.54) 
或 者 


fy = ACE) + Kyf [A -AD]dr (7.55) 


Ap, KaM KK, 是 合适 的 正定 矩阵 增益 。 比 例 反馈 可 
以 减 小 干扰 力 导致 的 力 误差 ， 而 积分 作用 能 够 补偿 党 
量 扰动 偏差 。 

力 反馈 的 实现 需要 从 对 末端 执行 器 力 螺 旋 h. 的 
测量 值 中 计算 力 乘 子 *， 这 可 以 利用 式 (7.31) 来 
得 到 。 

速度 控制 可 以 通过 下 面 的 设 定 来 得 到 

æ, = balt) + Kp loat) -v(t) 
+ Kf [n -elat 
RH, 天 ,和 天 ,是 合适 的 矩阵 增益 。 可 以 明显 看 出 ， 


对 于 任意 选取 的 正定 矩阵 Kb, 和 K,,, vy (i) 和 valt) 
的 渐 近 跟踪 都 保证 是 以 指数 收敛 的 。 
HEr 的 计算 可 以 利用 式 (7.31) 从 可 用 的 测 


(7. 56) 
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量 得 到 ， 其 中 利用 式 (7.1) 从 对 关 市 位 置 和 速度 的 
测量 值 可 以 计算 出 末端 执行 器 的 扭 矢 。 

式 (7.54) 或 式 (7.55) 与 式 (7.56) 表示 外 
控制 环 ， 它 保证 了 力 / 速 度 控制 和 扰动 抑制 。 

当 式 (7.27) AX (7.38) 已 知 按照 式 
(7.30) 和 式 (7.40) 可 以 计算 出 矩阵 SAS, #A 
通过 指定 期 望 力 A(t) 和 期 望 位 置 r,(t) 可 以 设计 
出 力 /位 置 控制 。 

力 控 制 可 以 像 上 面 那 样 设计 ， 而 位 置 控制 可 以 通 
过 设 定 
œ, = rt) + Ky [rt) -v(t)] +Kp lra(t) —r(t)] 
得 到 。 对 于 任意 选取 的 正定 矩阵 Ky, A Kp,，rs (i)、 
ra(t) 和 ri(t) 的 渐 近 跟踪 都 保证 是 以 指数 收敛 
的 。 利 用 式 (7.38) 从 关节 位 置 测量 值 可 以 计算 得 
到 位 置 反 馈 所 需要 的 向 量 ro 

2. 柔顺 环境 

在 柔顺 环境 情况 下 ， 按 照 对 末端 执行 器 位 移 的 分 
解 《7.42) ,未 端 执 行 器 的 扭 和 撩 可 以 分 解 为 

v,-Sy+C'S,a (7.57) 
式 中 ， 第 一 项 是 自由 扭 矢 ; 第 二 项 是 约束 扭 夭 ; 向 量 
v 与 式 (7.40) 中 的 定义 一 样 ; CEA (7.48) PE 


义 。 假 设 接触 几何 和 柔顺 是 不 变 的 ， 即 $, =0, C= 
0 和 S, =0， 对 于 加 速度 也 有 类 似 的 分 解 成 立 


v, =S,» +C'S,A (7. 58) 
可 以 采用 逆 动 力学 控制 率 (7. 15) ， 并 得 到 闭环 
(7. 16) ， 其 中 心 是 适当 设计 的 控制 输入 。 
考虑 到 加 速度 分 解 (7. 58)， 选 取 
4=Sa +C Si (7.59) 
BY DA fE J Pe l DA Ee RE, AAA 
(7.58) 和 式 (7.59) 代入 到 式 (7.16) 中 ， 并 在 所 
得 到 的 方程 两 边 都 各 左 葬 一 次 Si 和 一 次 St ， 可 以 得 
到 下 面 解 耦 的 方程 
(7. 60) 


py =a, 

A =f, (7.61) 

因此 ， 通 过 像 刚 性 环境 情况 那样 按照 式 (7.56) 选 

取 a,， 对 期 望 速度 w(t) 和 加 速度 v(t) 的 渐 近 跟 
踪 都 是 以 指数 收敛 保证 的 。 控 制 输 入 扩 可 以 选取 为 

f= Aal) +K LAAG) -ACt)] + Kp, LAC) -ACE ] 

(7.62) 

Xt FE SE AY EEEE OK, A Ka, REREN 


轨迹 (Ag(t), Ag(t), Ag(t)) 的 渐 近 跟踪 是 以 指 


BUSCA o 
与 刚性 环境 情况 不 同 ， 对 于 力 控 制 律 (7.62) 


的 实现 反馈 是 必需 的 。 这 个 量 可 以 由 末端 执行 器 
力 螺旋 的 测量 值 凡 计算 得 到 为 

A =Sth. 
然而 ， 由 于 力 螺 旋 的 测量 信号 往往 是 带 有 了 噪声 的 ， 反 
馈 经 常会 替换 为 


A =S'K'I(q) 4 (7. 63) 
其 中 关节 速度 是 采用 转速 计 测量 或 对 关节 位 置 进 行 数 
值 微分 计算 得 到 的 ，K' 是 描述 部 分 约束 的 相互 作用 的 
半 正 定 刚度 矩阵 (7.47)。 对 于 式 (7.63) 的 计算 ， 
RA KAAR 〈 或 估计 ) 是 必需 的 ， 并 不 需要 刚度 
EREK, HE, PERI (7.59) 的 实现 也 是 需要 部 分 
约束 相互 作用 的 柔顺 抢 阵 C' 的 知识 (或 估计 )， 而 不 
需要 完整 的 柔顺 和 矩阵 C。 

如 果 接 触 几何 是 已 知 的 , 但 只 有 环境 刚度 /柔顺 

的 估计 是 可 用 的 情况 下 ， 如 果 指 定 一 个 不 变 的 期 望 力 
A4， 控 制 律 (7.59) 与 式 《7.62) 一 起 仍 可 以 保证 
力 误 差 的 收敛 。 对 于 这 种 情况 ,控制 律 (7.59) 具 
有 形式 

a=S.a, +C'S, fa 


sth, C'=(1-P,)C, C 是 柔顺 矩阵 的 一 个 估计 。 因 
E, 式 (7.60) 仍然 成 立 ， 而 作为 替代 式 〈7.61)， 
可 以 得 到 下 面 的 等 式 


A =L fy 


sta, L= (STCS,) -'STCS, 是 一 个 非 奇 异 矩 阵 。 因 
此 ， 力 控制 和 速度 控制 子 空间 仍 保持 解 丰 ， 并 且 速 度 
控制 律 (7.56) 不 需要 修改 。 另 一 方面 ， 如 果 使 用 
st (7.63) 计算 和 A 的 时 间 导 数 作为 反馈 ， 只 能 得 到 


估计 A. FFAS (7.63)、 式 (7.57) 和 式 (7.46), 
可 以 得 到 下 面 的 等 式 


ASLA 
所 以 ,使 用 常量 和 A、 作为 A 的 替代 的 A AK, = KI, 
Dist (7.62) 计算 力 控 制 律 ,闭环 系统 的 动力 学 
方程 为 

A +K ,A+LK,A=LK,A 
表明 在 存在 不 确定 矩阵 情况 下 ， 通过 适当 选取 增 
at Kn, 和 Ky, ? 也 可 以 保证 平衡 状态 A= A, AA TBR 
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7.4.2 基于 无 源 性 的 方法 


基于 无 源 性 的 方法 利用 了 操作 手动 力学 模型 的 
无 源 特性 ， 其 对 于 有 和 约 东 的 动力 学 模型 式 (7.2) 
也 是 成 立 的 。 很 容易 看 出 对 能 在 关节 空间 保证 矩阵 
H(q) -2C(q, 4) 的 反对 称 性 的 矩阵 CCg，4 ) 的 
选取 ， 也 会 使 矩阵 4(g) -20(q, 4) 为 反对 称 。 这 
是 在 无 源 性 控制 算法 基础 上 的 拉 格 朗 日 系统 基本 
特性 。 

L 刚性 环境 

控制 力 螺旋 hh 可 以 选取 为 


h, =A(q)S,v,+0'(4,4)y,+(S})° 


K,(y, -v) +n) +S fy (7. 64) 


sth, r'a, 4) =TS, +AS,; K, 是 合适 的 对 称 正 
EERE, v, 和 下 是 适当 设计 的 控制 输入 。 
把 式 (7.64) RAR (7.2) 中 得 到 
A(q)S,5, +T'(g,g)s, + (S1)"K,s, +Si(f, -A) =0 
(7.65) 


Hh s,=v,-p 和 s, =v,-v， 表明 闭环 系统 仍 保留 
非 线 性 和 耦合 。 

sk (7.65) 两 边 都 左 乘 矩 阵 S,， 可 以 得 到 下 面 
的 降 阶 动力 学 表达 式 


A,(g)s, +T,(g,q)s, +K,s,=0 (7.66) 


其 路 =STT(g，9)S,+5S'A(gq) 5,。 可 以 很 容易 看 
出 矩阵 A (q) -20(q, @) 的 反对 称 性 意味 着 矩阵 
A.(q) -2T,(q，9) 也 是 反对 称 的 。 


另 一 方面 , 将 式 (7.65) PARARE S A (q), 
可 以 得 到 下 面 的 力 动态 表达 式 


fp -A= -ACDS ATUT (Cg g) +(S*) 天]s， 

(7.67) 

表明 力 乘 子 A 瞬时 地 取决 于 控制 输入 f， 但 也 在 速 
度 控制 子 空间 取决 于 误差 8,。 

按 以 下 选取 ， 可 以 保证 降 阶 系统 (7.66) 的 渐 

(7. 68 ) 

(7. 69) 


AIP, a 是 正 增益 ; yy 和 zv, 分 别 是 期 望 加 速度 和 速 
RE; Av=v,—-v, 以 及 Ax, = [av(t) dr. 
稳定 性 判 据 基于 正定 李 雅 普 诺 夫 函 数 


yp .=v,t+aAp 


VP. =P, + a@Ax, 


V= ADs, + aAx\K Ax, 
Week (7.66) 的 轨迹 ， 其 时 间 导 数 为 
V = -Av'K,Av -oa Ax'K,Ax, 
是 一 个 半 人 负 定 函数 。 因 此 ， 渐 近 地 Ay =0, Ax, =0 
和 s, =0。 所 以 ,保证 了 对 期 望 速度 v(t) WR ER. 
mA, st (7.67) 的 右 侧 保持 有 界 并 逐渐 为 零 。 所 
以 ， 按 照 式 (7.53) 、 式 (7.54) 或 式 (7.55) 的 选 
K, 通过 像 分 解 加 速度 方法 中 那样 设 定 凡 ， 就 可 以 
保证 对 期 望 力 A,(t) AER. 
注意 ， 假 如 按照 式 (7.30) MA (7.40) 来 计 
EE SAS, AHER (7.68) MA (7.69) 中 
使 用 向 量 Dp, = Tay Pi = ri 和 Ax, =P, T, 如 果 式 
(7.38) 中 的 向 量 r 指定 为 期 望 位 置 r,(t) ， 可 以 得 到 
位 置 控 制 。 
2. 柔顺 环境 
控制 力 螺 旋 .可 以 选取 为 


h. =A(g)v,+T(g,g)v,+Ks(v, -v,) +h,+n(q) 
(7.70) 

式 中 ，Ks 是 合适 的 对 称 正定 矩阵 ， 而 v, 及 其 时 间 导 
数 v MERA 

v, =v; +aAx 

v.=v,+adv 
th, a 是 正 增益 ; 及 其 时 间 导 数 ws 是 适当 地 设 
计 的 控制 输入 ; Av=v -v 并且 Ar = [ Avdr。 

把 式 (7.70) 代入 式 (7.2) 中 得 到 


A(q)s +T(g,qg)s+Kss=0 (7.71) 


H s =v,- v, Ñ s=, -vo 
通过 以 下 设 定 ， 可 以 保证 系统 (7.71) 的 渐 近 
稳定 性 : 


Va = SVa +C'S,A, 
sth, v(t) 是 期 望 速度 轨迹 ;As(i) 是 期 望 力 轨 
迹 。 稳 定性 判 据 基 于 正定 李 雅 普 诺 夫 函 数 





= 二 s74(9)s +a@Ax' K, Ax 


沿 着 式 (7.71) 的 轨迹 ， 其 时 间 导 数 为 ， 


V = —Av'K, Av - a’ Ax"K,Ax 
是 一 个 负 定 函数 。 因 此 , 渐 近 地 Av=0 和 Ax =0。 在 
接触 几何 和 刚度 不 变 的 情况 下 ,下面 的 等 式 成 立 
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Av=S,(v,-v) +C'S,(A, -A) 
Ax = s,Í Cy, —p)dt + C'S,(CA, 一 A) 


表明 属于 互 反 子 空间 的 速度 和 力 跟 踪 误 差 ， 都 渐 近 地 
收敛 到 零 。 


7.4.3 分 解 速度 方法 


分 解 加 速度 方法 以 及 基于 无 源 性 的 方法 都 需要 改 
造 现 有 工业 机 做人 控制 器 。 像 阻抗 控制 那样 ， 如 果 接 
触 足 够 订 顺 ， 运 动 控 制 的 机 器 人 闭环 动态 可 以 由 对 应 
于 速度 分 解 控制 的 式 (7.26) 近似 。 

按照 末端 执行 器 扭 和 撩 分 解 (7.57) ， 要 实现 力 和 
速度 控制 ， 控 制 输入 可 以 选取 为 


v, -Su +C'S f, (7.72) 
其 中 
v, = valt) + Kl [ma(r) —v(t)]dt (7.73) 
以 及 
F =A) +K a LAG) AC)] (7.74) 


AP, KA Kp, a rie TPR IE EE o EEH 
Hill A 4 tial Fe ZAKR, WRIA ARS I 
TUT Ra xe VE RI PA Be a) EDE ET AP EB, Mi 
且 ， 由 于 力 误 差 具 有 二 阶 动态 ,可 以 在 式 《7.74) 
上 增加 一 个 积分 作用 来 提高 扰动 抑制 能 力 ， 即 


六 = A(t) + Ka LAG) — ACA) ] 


+K, | [Aa(t) - a(t) ldt 





(7.75) 


并 且 如 果 和 矩阵 Ka 和 K EREE, a REHE 
数 渐 近 稳定 性 。 
与 分 解 加 速度 方法 中 一 样 ， 如 果 在 式 (7.72) 


中 使 用 环境 刚度 矩阵 的 估计 C， 对 于 式 (7.74) 
和 式 (7.75) 仍然 还 能 保证 和 指数 收敛 到 常 
量 Ago 

在 有 些 应 用 中 ， 除 了 刚度 矩阵， 环境 几何 也 是 不 
确定 的 。 在 这 些 情况 中 ， 可 以 不 使 用 选择 矩阵 St 和 
$, 把 力 控制 子 空间 从 速度 控制 子 空间 中 分 离 出 来 ， 就 
能 实现 类 似 式 (7.72) 的 力 /运动 控制 律 。 使 用 完整 
速度 反馈 ， 运 动 控 制 律 可 以 设 定 为 式 (7.73). Al 
样 ， 使 用 完整 的 力 和 运动 反馈 ， 力 控制 律 可 以 设 定 为 
st (7.75)。 也 就 是 说 ， 在 六 维 (6-D) 空间 的 所 有 
方向 上 都 既 施 加 了 运动 控制 又 施加 了 力 控制 。 所 得 到 
的 控制 ， 称 为 带 运动 前 馈 的 力 控制 或 力 /位 置 并 行 控 
制 。 由 于 存在 力 误差 的 积分 作用 ， 保 证 了 力 控制 相对 


位 置 控 制 的 主导 地 位 。 进 而 ， 以 沿 有 约束 作业 方向 的 
位 置 误 差 为 代价 保证 了 力 的 调节 。 
7.5 结论 与 扩展 阅读 
本 章 从 一 个 统一 的 角度 概述 了 力 控 制 的 主要 方 
法 。 但 是 ， 还 是 有 许多 没有 考虑 到 的 方面 ， 在 处 理 
交互 的 机 融 人 作业 时 必须 把 它们 仔细 地 考虑 进去 。 
力 控 制 的 两 种 主要 模式 (阻抗 控制 和 力 /运动 混合 
控制 ) 是 基于 几 个 简化 假设 的 ， 它们 在 实际 执行 中 
仅仅 部 分 地 满足 。 事 实 上 ， 力 控制 的 机 器 人 系统 的 
性 能 取决 于 同 变 化 的 环境 之 间 的 相互 作用 ， 这 种 变 
化 的 环境 是 非常 难以 建 模 和 正确 辨识 的 。 不 仪 在 定 
量 上 而 且 在 定性 上 ,一般 的 接触 状况 远 不 是 可 以 完 
全 预测 的 : 接触 构 型 可 能 突然 地 改变 , 或 者 是 不 同 
于 预期 的 类 型 。 因 此 ， 用 于 评价 一 个 控制 系统 的 标 
准 性 能 指标 ， 比 如 稳定 性 、 带 帘 、 精 度 和 和 鲁 棒 性 ， 
就 不 能 像 机 器 人 运动 控制 那样 只 考虑 机 器 人 系统 来 
定义 ， 而 必须 一 直 参 考 当 时 特别 的 接触 状况 。 而 且 ， 
对 所 有 这 些 不 同 状况 进行 分 类 也 是 不 容易 的 ， 尤 其 
是 在 动态 环境 情况 下 和 涉及 并 行 施加 的 多 个 接触 的 
作业 任务 。 

由 于 力 控 制 问题 回 有 的 复杂 性 ， 在 过 去 的 三 十 年 
中 有 大 量 关 于 这 个 主题 的 研究 论文 发 表 。 参 考 文献 
[7.20] 提供 了 对 第 一 个 十 年 的 发 展现 状 的 描述 ， 而 
第 二 个 十 年 的 进展 则 在 参考 文献 [7.21] 和 参考 文 
BA [7.22] 中 作 了 概述 。 最 近 ， 出 版 了 两 部 关于 力 
控制 的 专著 参考 文献 [7.23，24]。 在 下 文中 提供 了 
参考 文献 列表 ， 本 章 所 给 出 推导 的 更 多 细节 以 及 这 里 
没有 禾 盖 到 的 主题 都 能 在 里 面 找到 。 


间接 力 控 制 


用 于 关节 坐标 系 下 的 力 控制 的 广义 弹簧 和 阻尼 的 
概念 最 初 是 在 参考 文献 【7.3] 中 提出 的 ， 并 在 参考 
文献 [7. 10] 中 讨论 了 实现 问题 。 参 考 文献 [7.9] 
则 提出 了 笛 卡 儿 坐 标 系 下 的 刚性 控制 。 参 考 文献 
[7.25] 中 讨论 了 成 功 进行 刚性 零件 装配 的 基于 远 中 
心 柔 顺 的 装置 。 参 考 文献 [7.7] 提出 了 机 械 阻 抗 模 
型 的 最 初 想法 ， 用 于 控制 操作 手 和 环境 之 间 的 相互 作 
用 ， 并 在 参考 文献 【7.8] 中 给 出 了 类 似 的 公式 。 参 
考 文献 [7.26] 分 析 了 阻抗 控制 的 稳定 性 ， 并 在 参 
考 文献 [7.27] 中 考虑 了 与 刚性 环境 的 相互 作用 
问题 。 

为 克服 机 器 人 操作 手动 态 参数 的 不 确定 性 ， 提 出 
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了 自 适应 阻抗 控制 算法 ”””， 而 在 参考 文献 
[7.30] 中 则 给 出 了 和 鲁 棒 控 制 方案 。 阻 抗 控制 还 曾 用 
于 力 /运动 混合 控制 框架 中 “” 。 

参考 文献 [7.32] 是 一 个 关于 六 自由 度 〈 空 间 
的 ) 刚度 建 模 的 参考 工作 ， 而 在 参考 文献 【7. 33- 
35] 中 则 详细 地 分 析 了 空间 柔顺 的 特性 ; 参考 文献 
[7.36] 给 出 一 个 六 自由 度 可 变 柔 顺手 胸 ， 同 时 参考 
文献 [7.37, 38] 给 出 一 些 关 于 构建 为 特定 作业 优 
化 的 可 编程 柔顺 的 研究 。 参 考 文献 17.39]j 介绍 了 
利用 旋转 矩阵 导出 空间 柔顺 的 基于 能 的 方法 ; 基于 对 
末端 执行 器 姿态 的 不 同 表示 形式 ,包括 单位 四 元 组 在 
内 ， 各 种 六 自由 度 阻 抗 控 制 方案 在 参考 文献 [7.40] 
中 都 能 找到 。 在 参考 文献 [7.4] 中 基于 四 元 组 的 
公式 被 推广 到 非 对 角 分 块 刚度 矩阵 的 情况 。 在 无 源 性 
框架 下 对 空间 阻抗 控制 的 一 个 严密 的 处 理 可 见于 参考 
文献 [7.42]. 


7.5.2 作业 规范 


参考 文献 [7. 11] 中 介绍 了 自然 和 人 为 约束 以 
及 柔顺 坐标 系 的 概念 。 在 作业 坐标 系 形式 体系 下 ， 
参考 文献 [7. 12，43] 系统 地 发 展 了 这 些 想 法 。 参 
考 文 献 (7.44, 45] 讨论 了 关于 广义 力 和 速度 方 回 
的 互 反 性 的 理论 问题 ， 同 时 在 参考 文献 [7.46] 中 
论述 了 机 器 人 学 中 广义 着 的 计算 中 的 不 变性 。 人 参考 
文献 [7.47] 中 考虑 了 部 分 约束 作业 的 问题 ， 建 立 
了 半 正 定 刚 度 和 柔顺 人 盾 阵 模型 。 在 参考 文献 
(7.48, 49] 中 考虑 了 几何 不 确定 性 的 估计 问题 ， 
以 及 基于 约束 的 作业 规范 与 实时 作业 执行 控制 的 连 
接 问 题 。 这 个 方法 在 参考 文献 [7.50] 中 得 到 推 
广 ， 提 出 了 一 种 用 于 指定 复杂 作业 的 基于 约束 的 系 
统 方法 。 


7.5.3 力 / 运 动 混合 控制 


关于 力 控 制 的 早期 研究 可 见于 参考 文献 
[7. 101。 基 于 自然 和 人 为 约束 作业 的 公式 表示 “” ， 
参考 文献 [7.13] 介绍 了 最 初 的 力 / 位 置 混合 控制 的 
概念 。 在 参考 文献 [7.17] 中 给 出 了 对 操作 手动 态 
模型 的 显示 包含 ， 而 在 参考 文献 [7.51] 中 开发 了 
种 对 与 动态 环境 相互 作用 建 模 的 系统 方法 。 采 用 逆 
动力 学 控制 器 的 有 约束 公式 表示 在 稍 卡 儿 空 
间 呈 3 以 及 在 关节 空间 ' ”进行 了 论述 。 与 基于 
线性 化 方程 的 控制 器 一 起 ， 在 参考 文献 [7.16] 中 
也 使 用 了 有 约束 的 方法 。 在 参考 文献 [7.45] 中 所 
指出 的 不 变性 问题 在 其 他 的 论文 "'“” 中 被 正确 地 


处 理 了 。 在 参考 文献 [7.18, 54, 55] 中 针对 自 适 
应 控制 和 在 参考 文献 [7.56] 中 针对 重 棒 控制 ， 实 
现 了 从 无 约束 运动 控制 到 有 约束 情况 下 基于 模型 的 
方案 的 变换 。 

由 于 对 于 力 误 差 施 加 积分 作用 ， 力 控制 相对 运动 
控制 占 主 导 地 位 。 基 于 这 样 的 观念 ， 为 处 理 环境 几何 
不 确定 性 设计 的 方法 有 采用 前 馈 运 动 方案 的 力 控 
制 "和 并 行 力 /位 置 控制 ””。 在 参考 文献 [7.57] 
中 开发 了 一 个 并 行 力 /位 置 校 准 器 。 积 分 作用 来 消除 
稳 态 力 误差 是 传统 的 用 法 ; 其 稳定 性 在 参考 文献 
[7.57] 中 得 到 证 明 ， 同 时 参考 文献 [7.59, 60] 对 
关于 力 测量 时 延 的 鲁 棒 性 进行 了 人 研究 。 

在 与 环境 接触 过 程 中 力 控制 可 能 引起 不 稳定 表现 
已 经 被 普遍 地 意识 到 了 。 在 参考 文献 [7.61] 中 介 
绍 了 解释 这 个 现象 的 动态 模型 ， 而 实验 研究 可 见于 参 
考 文献 [7.62] 和 [7.63]。 此 外 ,控制 方 案 通 常 是 
在 操作 手 末端 执行 器 正在 与 环境 接触 并 且 这 个 接触 不 
会 失去 的 假设 下 得 到 的 。 冲 击 现象 可 能 会 出 现 并 应 该 
得 到 仔细 的 考虑 ， 而 且 对 控制 方案 的 整体 分 析 也 是 需 
要 的 ， 包 括 从 非 接触 到 接触 状况 的 转变 ， 反 之 亦 然 ， 
DESE 
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刘海 波 dh | 


”机 器 人 软件 系统 日 趋 复杂 ， 这 种 复杂 性 主要 源 
自 种 类 繁多 的 传感器 和 执行 器 的 实时 控制 的 需求 ， 


同时 还 要 面 对 不 可 忽视 的 不 确定 性 因素 和 各 种 品 
声 。 机 器 人 系统 需要 在 不 可 预知 的 情境 下 完成 任 
务 ， 既 要 监测 这 些 情境 的 变化 ， 又 要 作出 适当 的 响 
应 。 所 有 这 些 任务 都 需要 并 发 地 、 异 步 地 执行 ， 这 
无 疑 会 大 大 增加 系统 的 复杂 性 。. 

采用 精心 构思 的 体系 结构 ， 再 加 上 支持 该 体系 
结构 的 编程 工具 , 则 有 助 于 解决 这 些 复杂 性 问题 。 
目前 ， 还 没有 哪 一 种 体系 结构 是 万 能 的 ， 尺 有 所 短 
寸 有 所 长 ， 每 种 体系 结构 都 有 着 不 同 的 适用 领域 。 
针对 特定 应 用 进行 体系 结构 选 型 时 ， 要 深入 了 解 各 
种 体系 结构 的 优 缺 点 ， 这 一 点 非常 重要 。 

本 章 详 述 建立 机 器 人 体系 结构 的 各 种 方法 。 首 
先 介绍 基本 术 诸 及 相关 概念 (包括 机 器 人 体系 结 
构 的 发 展 历 程 ) ， 然 后 深入 探讨 目前 的 体系 结构 中 
常用 的 几 种 组 件 ， 包 括 行为 控制 ( 详 见 第 38 BE), 
执行 、 任 务 规划 ( 详 见 第 9 章 ) 以 及 这 些 组 件 互 


8.1 概述 


机 器 人 体系 结构 这 一 术语 党 包括 两 层 含义 ， 既 相 
联系 义 有 区 别 。 一 是 “结构 ”之 章 ， 指 一 个 系统 如 
何 划 分 为 子 系统 以 及 这 些 子 系统 之 间 如 何 相 互 作用 。 
机 器 人 系统 的 结构 党 用 框图 进行 形式 化 表示 ， 或 者 更 
正式 一 些 采 用 统一 建 模 语言 (UML) 技术 来 描 
述 *“"。 二 是 “风格 ”之 意 ， 指 支撑 特定 系统 的 计算 
模式 。 壁 如， 有 的 机 器 人 系统 采用 发 布 人 j[ 阅 进行 消 
息 传递 的 通信 和 模式， 而 有 的 则 采用 更 加 同步 的 客户 
机 /服务 器 模式 。 

所 有 机 器 人 系统 都 要 采用 某 种 体系 结构 和 计算 
模式 ,但 是 很 难 精确 地 说 现 有 的 系统 具体 用 的 是 哪 
一 种 。 实 际 上 ， 就 算是 单个 的 机 器 人 系统 ， 往 往 也 
揉 合 了 知 干 种 计算 模式 。 这 是 因为 ,系统 实现 时 可 


程 工具 和 开发 环境 贯穿 全 文 。 接 下 来 给 出 一 个 体系 
结构 实例 ， 最 后 进行 扼要 的 总 结 ， 并 介绍 一 些 可 供 
扩展 阅读 的 文献 资料 。 


8. 1 概述 150 
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8.3 体系 结构 组 件 pp 155 
8.3,1 连接 组 件 pp 155 
8. 3.2 行为 控制 157 
8.3.3 执行 158 
8.3.4 规则 159 

8.4 案例 研究 -一 -GRACE ee 160 

8.5 机 器 人 体系 结构 设计 艺术 pe 162 

8.6 结论 与 扩展 阅读 pp， 163 

参考 文献 和 163 


能 无 法 清晰 界定 子 系统 的 边界 ， 从 而 很 难 明 确 地 说 
它 确 属 哪 种 结构 ， 同 样 ， 体 系 结构 又 与 特定 领域 的 
实现 紧密 联系 在 一 起 ， 其 设计 风格 上 也 没有 清晰 的 
界线 。 

上 述 情况 很 令 人 遗憾 。 因 为 一 个 精心 设计 的 、 清 
晰 的 体系 结构 特别 有 利于 机 器 人 系统 的 规格 说 明 、 执 
行 和 验证 。 一 般 情况 下 ， 机 器 人 的 体系 结构 可 以 对 机 
器 人 系统 的 设计 和 实现 施加 恰当 的 (不 能 过 于 严格 ) 
约束 条 件 ， 从 而 有 助 于 加 速 开 发 进程 。 例 如 ， 将 行为 
组 件 划分 成 模块 单元 ， 便 有 助 于 增加 其 可 理解 性 和 可 
重用 性 ， 且 便于 单元 测试 与 验证 。 


8.1.1 机 器 人 体系 结构 的 特殊 需求 


从 某 种 意义 来 讲 ， 机 器 人 体系 结构 设计 可 以 被 看 
成 是 软件 工程 。 但 机 器 人 体系 结构 又 因 机 严 人 系统 的 
特殊 需求 而 有 别 于 其 他 软件 体系 结构 。 从 体系 结构 的 
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视角 看 ， 这 些 需 求 中 最 主要 的 是 机 器 人 系统 要 与 不 确 
定 的 、 又 经 常 是 动态 的 环境 进行 异步 的 、 实 时 的 交 
互 。 此 外 ， 很 多 机 器 人 系统 还 需要 在 各 种 时 间 扩 度 上 
做 出 响应 ， 从 毫秒 级 反馈 控制 到 分 钟 级 、 小 时 级 的 复 
杂 任 务 处 理 。 

为 了 满足 上 述 需求 ， 很 多 机 器 人 的 体系 结构 都 包 
含 了 实时 行动 、 执 行 器 及 传感器 控制 、 并 发 支持 、 异 
常情 况 检测 与 响应 、 不 确定 性 处 理 、 高 级 〈 符 号 级 ) 
规划 与 低级 (数值 级 ) 控制 集成 等 多 种 能 力 。 

尽管 同样 的 能 力 可 以 采用 不 同 的 结构 模式 来 实 
现 ， 但 采用 某 种 特定 的 模式 可 能 会 好 于 其 他 模式 。 举 
个 例子 ， 现 在 来 看 看 机 器 人 系统 的 通信 模式 能 如 何 影 
响 其 可 靠 性 。 很 多 机 器 人 系统 都 被 设计 成 消息 传递 的 
异步 通信 过 程 。 客 户 机 /服务 器 是 一 种 常用 的 通信 模 
式 ， 在 该 模式 中 , 来 自 客户 机 的 每 个 消息 请 求 都 与 来 
自 服 务 器 的 响应 相对 应 。 发 布 /订阅 是 另 一 种 通信 模 
式 ， 其 中 消息 都 是 被 异步 地 广播 出 去 的 ， 所 有 此 前 提 
出 过 对 这 些 消息 感 兴趣 的 通信 模块 都 能 收 到 消息 的 副 
本 。 采 用 客户 机 /服务 器 模式 进行 消息 传递 ， 通 信和 模 
块 发 送 一 个 请 求 后 就 进入 阻塞 状态 ， 以 等 待 响 应 。 如 
果 所 期 待 的 响应 望 穿 秋水 也 等 不 来 (如 服务 器 模块 
出演 了 ) ， 则 会 发 生死 锁 。 即 使 请 求 模块 不 阻 寒 ,， 其 
控制 流 依然 会 期 待 着 响应 。 如 果 响 应 永 不 到 达 或 者 其 
他 请 求 的 响应 不 期 而 至 ， 则 会 发 生 无 法 预料 的 结果 。 
相反 ， 采 用 发 布 /订阅 模式 的 系统 则 更 可 靠 一 些 ， 因 
为 消息 都 已 被 假定 为 异步 到 达 的 ， 控 制 流 不 会 再 假设 
按 哪 种 特定 顺序 处 理 消息 ， 所 以 ,消息 丢失 或 者 乱 序 
产生 的 影响 就 比较 小 。 


8. 1.2 模块 化 与 层次 化 


机 器 人 体系 结构 的 一 个 重要 作用 就 是 将 系统 分 解 
成 更 简单 的 、 在 很 大 程度 上 比较 独立 的 模块 。 正 如 前 
面 讲 过 的 ， 机 器 人 系统 经 常 被 设计 成 通信 过 程 ， 其 通 
信 接 口 很 少 且 带宽 相对 较 低 。 如 此 设计 能 使 通信 模块 
异步 地 处 理 与 环境 的 交互 过 程 ， 且 最 小 化 与 其 他 模块 
的 交互 。 显 然 ， 这 样 可 以 降低 整个 系统 的 复杂 性 ， 增 
加 整个 系统 的 可 靠 性 。 

通常 ， 系 统 的 分 解 是 分 层次 的 一 一 一 些 模块 组 
件 建立 在 另 一 些 模块 组 件 之 上 。 显 式 地 支持 此 类 分 
层 分 解 的 体系 结构 通过 抽象 技术 来 降低 系统 的 复杂 
度 。 然 而 ， 尽 管 机 器 人 系统 的 分 层 分 解 已 是 众望 所 
归 ， 但 是 究竟 沿 着 哪 一 个 维度 进行 分 解 还 是 众说 纷 
经 、 百 花 齐 放 。 有 些 体系 结构 沿 着 时 间 维 进行 分 
解 一 ”每 层 操作 的 响应 频率 都 比 其 下 一 层 低 一 个 数 
量 级 "1 。 而 有 些 体系 结构 则 基于 任务 抽象 进行 分 











层 一 一 每 层 的 任务 通过 调用 其 下 一 层 的 一 组 任务 来 
完成 “”“ 。 在 某 些 情 况 下 ， 基 于 空间 抽象 进行 分 解 
会 更 好 ， 比 如 有 既 要 处 理 局 部 导航 又 要 处 理 全 局 导航 
的 时 候 “”。 最 主要 的 一 点 是 ， 不 同 的 应 用 场合 需 
要 用 不 同 的 分 解 方式 ， 而 采用 的 结构 模式 则 要 与 之 
相 适 应 。 


8.1.3 软件 开发 工具 


采用 明确 定义 的 结构 模式 来 设计 系统 其 好 处 是 很 
明显 的 ， 同 时 ， 许 多 结构 模式 也 有 相关 的 软件 工具 为 
实现 这 种 模式 提供 有 力 的 支持 。 这 些 工 具 以 多 种 形式 
存在 ， 如 函数 库 、 专 用 编程 语言 或 图 形 编辑 器 。 这 些 
工具 屏蔽 了 概念 上 的 复杂 性 ， 对 结构 模式 的 约束 更 
清晰 。 

例如 ， 进 程 间 通 信 库 (如 通用 对 象 请 求 代理 体 
系 结构 CORBA) 引 和 进程 间 通信 和 包 PC), fE 
得 消息 传递 模式 (如 客户 机 /服务 器 和 发 布 / 订 阅 模 
xk) 实现 起 来 非常 轻松 。 诸 如 Subsumption 01 和 
Skills 等 语言 则 有 助 于 开发 数据 驱动 的 、 实 时 行 
为 ， 而 ESL (执行 支持 语言 )* "和 PLEXIL (规划 执 
行 交换 语言 )'* ”等 语言 则 为 可 靠 实现 高 级 任务 提供 
支持 。 对 于 图 形 编辑 器 ， 如 ControlShelll* i, Lab- 
view !® 9) 和 ORCCAD (开放 机 器 人 控制 器 计算 机 辅助 
设计 ) 下 4 等 ， 则 为 系统 集成 提供 了 约束 方式 ， 并 可 
自动 生成 支持 该 结构 模式 的 代码 。 

无 论 哪 种 情况 ， 这 些 工具 都 可 以 使 特定 模式 的 软 
件 开发 变 得 很 容易 。 更 重要 的 是 ， 它们 可 以 确保 不 
( 至 少 是 很 难 ) 违背 结构 模式 的 约束 条 件 。 于 是 ， 用 
这 些 工 具 开 发 的 系统 更 易于 实现 、 理 解 、 调 试 、 验 证 
和 维护 。 同 时 这 些 系统 也 更 可 靠 ， 因 为 这 些 软件 工具 
为 控制 结构 的 一 般 需 求 提供 了 和 良好 的 设计 能 力 ， 如 消 
息 传递 、 与 执行 器 和 传感器 的 接口 以 及 并 发 任务 处 
理 等 。 





8.2 发 展 历 程 

机 器 人 体系 结构 和 程序 设计 始 于 20 世纪 60 年 代 
未 斯 坦 福 大 学 的 Shakey HLAS (如 图 8.1 所 
示 )。Shakey 装配 有 1 台 摄 像 机 、1 台 测 距 仪 和 碰撞 
检测 传感器 ， 并 通过 无 线 和 视频 链 路 连接 到 DEC 
PDP10 和 PDP-15 计算 机 。Shakey 的 体系 结构 被 分 解 
为 3 个 功能 单元 : 感知 、 规 划 和 执行 上 ” 。 感 知 系统 
将 摄像 机 采集 的 图 像 转 换 为 内 部 环境 模型 。 规 划 器 接 
受 根据 内 部 环境 模型 和 目标 生成 一 个 可 以 达到 目标 的 
规划 《〈 即 动作 序列 ) 。 执 行 器 接收 规划 结果 并 给 机 天 
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人 发 出 动作 指令 。 上 述 方 法 被 称 为 感知 -规划 -动作 8.2.1 包容 结构 
(SPA) 范 型 (如 图 8.2 所 示 ) 。 这 种 体系 结构 的 主要 T i 
特点 是 : 感知 数据 被 转换 为 一 个 环境 模型 ， 该 模型 为 20 世纪 80 年 代 初 ，SPA 范 型 的 问题 逐渐 暴露 出 
规划 备 所 用 ， 规 划 执 行 时 不 再 直接 与 传感器 打交道 。 来 。 第 一， 在 真实 环境 中 进行 规划 耗 时 太 长 机 器 人 
其 后 很 多 年 ， 机 器 人 的 控制 结构 和 程序 设计 几乎 无 一 此 时 处 于 阻塞 状态 等 待 规划 结果 。 第 二 ， 也 是 更 重要 
例外 地 都 采用 了 SPA 范 型 。 的 一 点 ， 规 划 执 行 时 不 再 处 理 感 知 信息 ， 这 在 动态 环 
as 境 中 是 很 危险 的 。 于 是 一 些 新 型 的 机 器 人 控制 结构 范 
型 开始 回 圳 头角， 其 中 包括 反应 型 规划 ， 可 以 快速 生 
成 规划 结果 ， 且 规划 过 程 更 直接 地 依赖 于 感知 信息 而 
不 是 内 部 模型 .中 。 最 有 影响 力 的 一 项 成 果 是 
Brooks 提出 的 包容 结构 "，。 包 容 结构 由 相互 作用 的 
有 限 状 态 机 分 层 构成 一 一 每 层 都 是 把 传感器 和 执行 器 
直接 连接 起 来 〈 如 图 8.3 所 示 )。 这 些 有 限 状态 机 被 
称 为 行为 《有 人 因此 将 包容 结构 称 为 基于 行为 的 机 
器 人 或 者 行为 机 器 人 技术 “"” ， 参 见 第 38 章 ) 。 因 为 
任 一 时 刻 都 能 有 多 种 行为 被 激活 ， 所 以 包容 结构 设计 
了 仲裁 机 制 ， 使 得 高 级 行为 能 够 抑制 低级 行为 。 例 
图 8.1 Shakey ( ¥# sri. com FRI ) 如 ， 机 器 人 可 以 有 一 种 简单 地 随机 游 走 的 行为 ， 这 种 
行为 总 是 处 于 激活 状态 ， 于 是 机 顺 人 总 是 这 上 儿 走 走 那 
儿 走 走 。 片 刻 之 后 ， 高 级 行为 接收 到 传感器 的 输入 信 
息 ， 检 测 到 有 障碍 物 ， 于 是 操纵 机 器 人 远离 障碍 物 。 








w| ET Wt 4 E> 、 
gl m| xe z 高 级 行为 也 总 是 处 于 激活 状态 。 在 没有 障碍 物 的 环境 
感 器 —> e 执行 器 ae me ` 
SEEI j we) | | ' 中 ， 高 级 行为 从 不 生成 信号 ， 但 若 检测 到 障碍 物 ， 它 
便 抑 制 低级 行为 而 操纵 机 器 人 离开 。 一 旦 障碍 物 消失 
(高 级 行为 停止 发 送信 号 ) ， 低 级 行为 便 重 新 获得 控 
图 8.2 感知 -规划 -动作 (SPA) EB 制 权 。 增 加 行为 交互 层 就 可 以 构建 出 越 来 越 复 杂 的 机 
( 引 自 文献 [8.3 ] ， 许 可 使 用 ) 着 人。 
漫游 
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图 8.3 包容 结构 实例 ( 引 自 参考 文献 [8.3 」] ， 许 可 使 用 ) 


有 不 少 机 器 人 是 采用 包容 方法 构建 的 ， 且 大 部 分 。 捷 。 它 们 不 会 被 动态 变化 的 环境 所 困扰 ， 因 为 它们 持 
都 在 MIT’ 7?) ， 均 相当 成 功 。 相 比 SPA 机 器 人 的 反 ”” 续 地 感知 环境 并 做 出 反应 。 这 些 机 器 人 能 像 昆 虫 或 小 
应 迟钝 、 动 作 笨拙 ， 包 容 机 器 人 则 反应 灵敏 、 动 作 迅 。 型 哮 齿 动物 一 样 跑 来 跑 去 。 除 了 包容 结构 ， 还 有 男 外 


第 8 章 机 器 人 体系 结构 与 程序 设计 153 


儿 种 行为 结构 ， 通 常 都 有 不 同 的 仲裁 方案 来 融合 行为 
输出 结果 21。 =- 

Arkin 提出 的 马达 -控制 图 式 “” 也 是 一 种 常见 的 
基于 行为 的 体系 结构 。 在 这 种 生物 启发 的 方法 中 ， 马 
达 与 知觉 图 式 * ”| 被 动态 地 互 连 起 来 。 马 达 图 式 基于 
知觉 图 式 生 成 响应 向 量 ， 然 后 用 与 势 场 法 “ ”1 相似 的 
方式 组 合 起 来 。 为 了 完成 更 复杂 的 任务 ， 自 主机 器 人 
体系 结构 ( AuRA)“”” 中 还 将 基于 有 限 状 态 接收 器 
(FSA) 的 导航 规划 器 和 规划 序列 器 加 入 到 反应 图 
As 

然而 好 景 不 长 ， 基 于 行为 的 机 器 人 不 久 就 暴露 出 
了 能 力 上 的 局 限 。 它 很 难 把 行为 组 合 起 来 去 实现 长 远 
目标 ， 它 也 几乎 不 可 能 对 机 器 人 的 行为 进行 优化 。 例 
如 ， 想 造 一 台 能 在 办 公 楼 里 投递 信件 的 基于 行为 的 机 
器 人 很 容易 ， 只 要 能 进行 简单 的 办 公 楼 漫游 ， 并 设计 
一 个 搜索 房间 的 行为 通过 抑制 漫游 即 可 进入 办 公 室 。 
但 如 果 用 行为 结构 模式 去 设计 一 个 系统 ， 能 根据 当天 
的 邮件 进行 推理 ， 按 照 最 优 顺 序 进入 办 公 室 从 而 最 小 
化 投递 时 间 ， 则 难于 上 青天 。 其 实 ， 机 器 人 最 需要 的 
是 将 早期 体系 结构 的 规划 能 力 与 基于 行为 的 体系 结构 
的 反应 能 力 紧 密 结合 起 来 ， 这 便 催生 了 机 器 人 的 分 层 
或 分 级 控制 结构 。 


8.2.2 分 层 控 制 结构 


Firby 开发 的 反应 动作 包 〈RAP) 系统 是 向 反应 
与 慎 思 相 集 成 而 迈 出 第 一 步 后 所 取得 的 成 果 之 一 。 在 
Firby 的 论文 1 中 ， 可 以 看 到 第 一 个 集成 方案 一 一 
三 层 结构 。 其 中 的 中 间 层 即 RAP 系统 ， 是 论文 的 核 
心 内 容 。Firby 也 构思 了 其 他 两 层 的 形式 和 功能 ， 尤 
其 想到 要 把 传统 的 慎 思 方法 与 当时 初 露 端倪 的 情境 推 
理 技术 结合 起 来 ， 可 人 惜 未 能 实现 。 后 来 ，Firby 将 
RAP 与 低级 的 控制 层 集成 到 了 一 起 “” 。 

与 此 同时 ，MITRES 的 Bonasso 也 独立 设计 出 了 一 
种 体系 结构 ， 底 层 用 Rex 语言 将 机 器 人 行为 编程 为 同 
步 回 路 中 2 ， 这 些 被 称 为 Rex 机 的 回路 能 够 确保 Agent 
内 部 状态 与 所 处 环境 的 语义 一 致 性 。 中 间 层 是 采用 
GAPPS 语言 “六 实现 的 条 件 序 列 器 ， 能 够 不 断 地 激活 
和 抑制 Rex 技能 直到 机 器 人 完成 任务 。 基 于 GAPPS 的 
序列 器 很 受 青睐 ， 因 为 它 综合 了 众多 的 传统 规划 技 
ARES) 。 这 项 成 果 在 3T 结构 ( 因 其 集成 了 规划 、 序 列 
化 和 实时 控制 这 3 个 控制 过 程 并 构成 3 个 层级 而 得 名 ) 
中 登峰造极 ,已 被 用 在 几 代 机 器 人 上 “”。 


O PARE: 美国 的 一 个 非 僵 利 性 研发 机 构 。 


随后 ， 人 们 又 开发 了 不 少 与 3T 结构 (如 图 8.4 
所 示 ) 类 似 的 体系 结构 。ATLANTIS'* 引 便 是 一 例 ， 
它 将 更 多 的 控制 功能 留 给 了 序列 层 。 在 该 体系 结构 
中 ， 慎 思 层 必须 明确 地 被 序列 层 调用 。Saridis 提出 的 
智能 控制 结构 “” 也 是 一 例 ， 它 使 用 Vxwork REA 
RA VME 总 线 ， 底 层 是 伺服 系统 ， 并 将 上 一 层 的 热 
行 算法 也 集成 进来 。 上 一 层 由 一 组 能 对 低层 子 系统 
(如 视觉 、 手 辟 运 动 和 导航 ) 进行 协调 的 例 程 构成 ， 
采用 Petri 网 转换 器 (PNT) 实现 (PNT 是 一 种 调度 
机 制 ) ， 由 与 组 织 层 相连 接 的 调度 器 来 激活 。 组 织 层 
是 一 个 用 Boltzmann 神经 网 络 实现 的 规划 器 ， 神 经 网 
络 主要 用 来 计算 满足 要 求 (这 些 要 求 是 以 文本 格式 
输入 进来 的 ) 的 动作 序列 ， 然 后 ， 调 度 器 通过 PNT 
协调 器 来 逐步 执行 规划 结果 。 





规划 层 持续 状态 与 选择 


执行 


NI 


立即 动作 记忆 


行为 控制 层 f 有 限 状态 





环境 
三 层 结构 原型 


图 8.4 


自主 系统 体系 结构 LAAS 是 一 种 每 层 都 有 软件 工 
RXR RAR”), RIRE COREA) 由 
模块 网 络 构成 ， 这 些 模块 都 是 由 动态 参数 控制 的 感知 
算法 ， 采 用 GenoM (模块 生成 器 ) 语言 写成 ，GenoM 
能 生成 标准 模板 以 便于 模块 集成 。 与 其 他 多 大 数 三 层 
结构 都 不 同 ，LAAS 的 执行 层 相当 简单 ， 只 有 纯粹 的 
反射 ， 而 不 对 任务 做 任何 分 解 ， 它 只 是 起 到 一 个 桥梁 
作用 一 一 从 高 层 接收 任务 序列 ， 做 出 选择 和 参数 化 处 
理 后 送 到 功能 层 。 执 行 层 由 Kheops 语言 写成 ， 该 语 
言 能 够 自动 生成 可 以 被 形式 化 验证 的 决策 网 。 最 上 面 
的 决策 层 由 规划 器 和 监督 嚣 构成， 规划 器 是 用 IxTeT 
(索引 时 间 表 ) 时 序 规划 器 ”实现 的 ， 监 督 器 是 
用 PRS (过 程 推理 系统 )“”“ 实现 的 。 监 督 器 与 其 
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他 类 型 三 层 结构 的 执行 层 类 似 ， 能 对 任务 进行 分 解 、 
对 可 互 换 方法 进行 选择 、 对 执行 进行 监测 。 通 过 将 规 
划 器 和 监督 器 集 于 一 层 ，LAAS 使 这 二 者 结合 更 紧 
密 ， 在 何 时 重 规划 、 如 何 重 规划 方面 就 有 了 更 大 的 灵 
活性 。 实 际 上 ，LAAS 体系 结构 允许 在 较 高 级 的 抽象 
层 上 有 多 个 决策 层 ， 如 较 高 级 的 使 命 层 和 较 低级 的 任 
务 层 。 

Me Agent 是 飞船 自主 控制 的 体系 结构 “i ， 它 
实际 上 是 由 4 层 构成 ， 即 控制 层 〈 也 称 行为 层 ) 、 执 
We. MME (或 调度 层 ) 以 及 MIR (模式 鉴别 与 
恢复 ) 层 ，MIR 层 包 括 故 障 检测 与 恢复 功能 。 控 制 
层 就 是 传统 的 飞船 实时 控制 系统 。 执 行 层 是 该 体系 结 
构 的 核心 ， 它 能 分 解 、 选 择 和 监测 任务 的 执行 ， 能 热 
行 故障 恢复 以 及 资源 管理 (适时 地 启动 和 关闭 设备 
以 节约 有 限 的 飞船 电力 )。 规 划 器 (调度 器 ) 是 一 个 
批 处 理 过 程 ， 它 根据 目标 、 初 始 (发 射 时 的 ) 状态 
和 当前 计划 活动 生成 规划 。 这 些 规 划 可 以 是 从 任务 启 
动 到 结束 之 间 任 一 时 段 。 规 划 中 也 可 以 包含 “重新 
调用 规划 器 生成 下 一 阶段 规划 ”的 任务 。 配 置 管理 
是 遥控 Agent 中 的 一 个 重要 部 分 ， 它 可 以 配置 硬件 以 
支持 任务 ， 并 监测 硬件 保持 在 已 知 的 、 稳 定 的 状态 。 
配置 管理 的 角色 被 划分 到 执行 层 和 MIR 层 两 层 中 ， 
执行 层 中 主要 使 用 反射 过 程 ，MIR 层 中 使 用 飞船 已 声 
明 的 模块 和 慎 思 算法 来 确定 如 何 重 新 配置 硬件 以 啊 应 
检测 到 的 故障 “|。 

联合 体系 结构 “” 将 3T 模式 拓展 到 多 机 器 人 协 
调 领域 ( 见 第 40 章 ) 。 在 该 体系 结构 中 ， 每 层 不 仅 
与 上 下 层 有 接口 ， 还 与 其 他 机 器 人 的 同一 层次 有 接 
口 ， 如 图 8. 5 所 示 。 这 样 一 来 ， 分 布 式 控制 环 可 以 设 
计 在 多 个 抽象 级 别 上 。 参 考 文献 [8.48] 中 的 联合 
体系 结构 ， 其 规划 器 使 用 基于 分 布 式 市 场 的 方法 进行 
任务 分 配 。 





文献 中 还 有 一 些 值得 注意 的 多 层 体 系 结构 。 由 美 
国 国家 标准 局 (NBS) 为 美国 航空 航天 局 (NASA) 
开发 的 NASA/NBS 标准 参考 模型 (NASREM ) ?4 
就 是 早期 的 膛 操 作 机 器 人 参考 模型 ， 如 图 8.6 所 示 ， 
后 来 被 称 为 实时 控制 系统 (RCS)。 它 是 一 个 多 层 模 
型 ， 每 层 都 采用 相同 的 通用 结构 ， 从 伺服 层 到 推理 
层 ， 随 着 抽象 程度 的 升 高 ， 操 作 频 率 不 断 降低 。 除 维 
护 全 局 环境 模型 外 ，NASREM 和 3T 结构 一 样 一 开始 
就 提供 了 所 有 数据 和 控制 路 径 。 但 NASREM 只 是 个 
参考 模型 ， 并 非 具体 实现 。NASREM 后 来 的 实现 基 
本 都 是 遵从 SPA 方法 做 的 ， 且 主要 应 用 在 遥 操 作 机 
器 人 【而 不 是 自主 机 器 人 ) E, {E Blidberg 早期 的 工 
作 “” 是 个 例外 。 





感知 值 判 定 
过 程 环境 建 模 





| 


图 8.6 实施 控制 系统 (RCS) 参考 体系 结构 
( 引 自 参考 文献 [8.46] ， 许 可 使 用 ) 


在 机 器 人 三 层 体系 结构 争奇斗艳 的 时 候 ， 各 种 
双 层 体系 结构 也 在 悄然 绽放 。 自 主机 器 人 双 层 体系 
结构 (CLARAty) 就 是 被 设计 成 用 来 支持 NASA 空 
间 机 器 人 《特别 是 行星 漫步 者 机 器 人 “1) 的 软 
件 可 重用 的 。CLARAty 由 一 个 功能 层 和 一 个 决策 层 
构成 。 功 能 层 是 一 个 面向 对 象 算法 层 ， 能 提供 众多 
到 机 器 人 的 抽象 接口 ， 如 马达 控制 、 载 体 控制 、 基 
于 传感器 的 导航 和 移动 操作 等 。 每 个 对 象 都 提供 一 
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般 的 (不 依赖 于 硬件 的 ) 接口 ， 因 此 相同 的 算法 可 
以 运行 在 不 同 的 硬件 上 。 决 策 层 融合 了 规划 和 执行 
能 力 ， 与 LAAS 体系 结构 一 样 ， 可 以 紧密 协调 规划 
和 执行 ， 使 得 为 响应 动态 的 偶然 事件 而 连续 进行 重 
规划 成 为 可 能 。 

CLARAty 的 决策 层 具体 说 就 是 个 CLEaR (闭环 
pT SRE) ， 它 将 基于 修复 的 规划 器 CASPER 
(连续 动作 调度 、 规 划 、 执 行 与 重 规划 )“ 和 TDL 
(任务 描述 语言 )“” 组合 起 来 。CLEaR 为 目标 驱动 
的 行为 和 事件 驱动 的 行为 提供 了 一 种 紧 耦 合 方法 。 根 
据 热 行 监测 进行 高 频 度 的 状态 与 资源 更 新 ， 然 后 快速 
处 理 、 连 续 重 规划 的 能 力 ， 是 CLEaR 的 核心 内 容 。 
这 使 得 规划 器 可 以 处 理 很 多 异常 情况 ,这 在 任务 多 、 
资源 少 、 不 确定 性 强 的 情况 下 尤为 重要 。 在 CLEaR 
中 ， 规 划 和 执行 组 件 都 能 处 理 资 源 冲 突 和 异常 情况 ， 
在 特定 的 情况 下 ,采用 启发 式 方法 来 确定 该 调用 哪个 
组 件 。OASIS (机 载 自 主 科 考 系统 )“” 对 CLEaR 进 
行 了 拓展 ， 将 科学 数据 分 析 功 能 也 纳入 其 中 ， 于 是 ， 
这 种 体系 结构 还 可 以 由 带 有 机 缘 上 巧合 性 质 的 科学 上 且 标 
来 驱动 ， 如 寻找 特殊 的 岩石 或 构造 。OASIS 是 以 规划 
器 为 中 心 的 ， 在 任务 调度 开始 前 仅 需 几 秒 钟 就 可 以 将 
任务 发 送 到 执行 组 件 。 

协作 智能 实时 控制 体系 结构 (CIRCA) 也 是 一 种 
双 层 结构 ， 它 关注 的 是 如 何 确保 可 靠 行 为 和 7 和 。 它 
实现 了 有 界 反应 ， 这 是 一 种 机 器 人 资源 不 总 是 那么 充 
足 时 为 保证 完成 所 有 任务 而 采取 的 响应 。CIRCA 由 
实时 系统 (RTS) 和 相当 独立 的 人 工 智 能 系统 
(AIS) 构成 。RTS 执行 测试 动作 对 (TAP) 周期 调 
BE, TAP 已 经 根据 感知 到 的 环境 信息 和 有 条 件 的 响应 
动作 确保 了 最 坏 情 况 下 的 行为 。AIS 的 职责 是 创建 调 
度 ， 且 确保 在 实时 执行 期 间 不 出 现 灾难 性 故障 。AIS 
是 通过 在 状态 转移 图 上 的 规划 来 做 到 这 一 点 的 ， 状 态 
转移 图 中 包括 动作 、 外 部 事件 和 时 间 流 逝 (机 器 人 
等 待 时 间 太 久 也 会 发 生 不 测 ) 造成 的 状态 转移 。AIS 
测试 每 一 个 规划 (TAP 集 )， 看 其 是 否 能 被 实际 调 
度 。 如 果 不 能 ， 则 调换 一 个 规划 模型 或 者 剔除 任 
Z (根据 日 标 优先 级 )， 或 者 调整 行为 参数 (如 降低 
机 器 人 速度 ) AIS 如 此 往复 ， 直 到 找到 一 个 可 以 成 
功 调度 的 规划 为 止 ， 然 后 便 将 这 个 新 规划 在 一 个 原子 
操作 步骤 内 下 载 到 RTS 中 。 





和 CIRCA 一 样 ， 前 面 提 到 过 的 ORCCAD 也 是 一 
个 确保 可 靠 性 的 双 层 体系 结构 ""” ,不同 的 是 ， 
ORCCAD 是 通过 形式 化 验证 技术 来 实现 这 种 保证 的 。 
机 器 人 任务 〈 低 级 行为 ) 和 机 器 人 过 程 (高 级 动作 ) 
都 是 由 高 级 语言 定义 的 ， 然 后 再 翻译 成 Esterel 语 
言 *“ 昌 进行 逻辑 验证 , 或 者 翻译 成 时 控 Argus if 
言 人 “个 旺 进 行 时序 验 证 。 这 些 验 证 方法 要 做 些 调整 ， 
以 适应 生存 性 、 安 全 性 以 及 资源 冲突 的 验证 。 


8.3 体系 结构 组 件 


本 章 以 三 层 结构 为 原型 探讨 体系 结构 组 件 。 图 
8.4 给 出 了 一 种 典型 的 三 层 体系 结构 。 其 底层 为 行为 
控制 层 ， 与 传感器 和 执行 器 紧密 相连 。 第 二 层 为 执 
行 层 ， 负 责 选择 机 器 人 当前 行为 以 完成 任务 。 最 高 
层 是 任务 规划 层 ， 负 责 在 资源 约束 条 件 下 实现 机 一 
人 的 长 远 目标 。 以 办 公 室 投递 机 器 人 为 例 ， 行 为 层 
负责 机 器 人 在 房间 和 走廊 中 的 移动 、 避 障 和 开门 等 ， 
执行 层 协 调 行为 层 以 完成 任务 ， 如 离开 房间 、 进 人 
办 公 室 等 ， 任 务 规划 层 负责 确定 最 省 时 间 的 投递 顺 
序 、 考 虑 投递 优先 级 、 调 度 、 充 电 等 ， 并 将 任务 
(如 退出 房间 、 进 入 110 室 ) 发 送 到 执行 层 。 上 述 
各 层 需要 协同 工作 并 且 交换 信息 。 下 一 节 先 研究 各 
组 件 的 连接 问题 ， 然 后 逐一 探讨 三 层 结构 中 的 各 个 
组 件 。 


8.3.1 连接 组 件 


本 章 探讨 过 的 所 有 体系 结构 组 件 之 间 都 需要 通 
信 ， 包 括 交 换 数 据 和 发 送 指令 。 组 件 通信 【 篆 称 为 
中 间 件 ) 模式 的 选择 是 机 器 人 体系 结构 设计 者 做 很 
多 决策 时 必须 考虑 的 最 重要 的 、 约 束 性 最 强 的 问题 之 
一 。 根 据 以 往 的 经 验 ， 开 发 机 器 人 体系 结构 时 ， 很 多 
问题 都 与 组 件 间 的 通信 有 关 ， 且 大 量 的 调试 时 间 也 伦 
在 这 里 。 此 外 ， 一 旦 选 定 了 某 种 通信 机 制 ， 再 就 极 难 
更 改 ， 因 此 初期 的 决策 多 少年 都 不 再 改变 。 很 多 开发 
者 使 用 他 们 自己 的 通信 协议 ， 这 些 协 议 通 常 是 基于 
Unix 套 接 字 开 发 的 。 尽 管 这 样 做 可 以 对 消息 进行 定 
制 ， 但 是 可 靠 性 、 高 效 性 和 外 部 通信 和 包 的 易 用 性 等 优 
势 将 难以 发 挥 出 来 。 目 前 有 两 种 基本 的 通信 方法 一 一 
客户 机 /服务 器 和 发 布 /订阅 。 





日 、 译 者 注 : Esterel 语言 是 一 种 用 于 开发 复杂 反应 系统 的 同步 程序 设计 语言 。 


O Baer: 一 种 用 于 开发 分 布 式 程序 的 语言 。 
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1. 客户 机 /服务 器 

在 客户 机 /服务 器 (也 称 点 对 点 ) 通信 协议 中 ， 
组 件 之 间 直 接 对 话 。 远 程 过 程 调 用 (RPC) 协议 便 是 
一 个 很 好 的 例子 ，RPC 中 一 个 组 件 ( 作 为 客户 机 ) 
可 以 调用 另 一 个 组 件 〈 作 为 服务 器 ) 的 函数 和 过 程 。 
目前 很 流行 的 一 种 形式 是 通用 对 象 请 求 代理 体系 结构 
(CORBA), CORBA 人 允许 一 个 组 件 调用 另 一 个 组 件 实 
现 的 对 象 方法 ， 所 有 的 方法 调用 都 在 一 个 不 依赖 于 编 
Rete a A IDL (接口 定义 语言 ) 文件 中 定义 ， 每 个 组 
件 都 使 用 相同 的 DL 来 生成 代码 ， 并 与 组 件 一 起 编译 
用 以 处 理 通 信 事 务 。 这 样 做 的 好 处 是 ， 当 IDL 文件 改 
变 时 ， 使 用 该 IDL 的 所 有 组 件 可 以 自动 地 被 重新 编译 
(使 用 make 或 类 似 的 代码 配置 工具 ) 。CORBA WH 
请 求 代 理 (ORB) 在 很 多 主流 面向 对 象 语 言 中 都 可 
以 使 用 。 尽 管 有 免费 的 ORB 可 用 ,但 依然 有 许多 商 
用 ORB 存在 ,它们 能 提供 更 多 的 功能 和 更 好 的 技术 
sty. CORBA 的 不 足 之 外 是 使 应 用 程序 额外 增加 了 
一 些 代码 。 一 - 些 竞 争 者 已 经 在 努力 解决 这 个 问题 ， 如 
ICE (Internet 通信 引擎 ) 开发 了 自己 的 IDL 文件 版 
Æ, PRIE SLICE (ICE 规格 说 明 语言 )。 客 户 机 /服务 
佛 协 议 最 大 的 优点 是 事先 将 接口 定义 得 非常 清晰 ， 当 
接口 改变 时 ， 大 家 都 能 知道 。 另 一 个 优点 是 在 无 中 心 
模块 又 需要 分 发 数据 时 它 允 许 分 布 式 通信 和 方法。 客户 
机 /服务 天 协议 的 缺点 是 通信 开销 大 ， 尤 其 在 许多 组 
件 需要 相同 信息 时 。 需 要 指出 的 是 ，CORBA 和 ICE 
还 具有 广播 机 制 〈 在 CORBA 中 称 为 事件 通道 或 通知 
服务 ) 。 

2. 发 布 /订阅 

在 发 布 /订阅 〈 也 称 广播 ) 协议 中 ,一 个 组 件 发 
布 数据 ， 其 他 任何 组 件 都 可 以 订阅 这 些 数 据 。 典 型 
地 ,一 个 中 央 处 理 程序 在 发 布 者 和 订阅 者 之 间 发 送 数 
据 。 在 一 个 典型 的 体系 结构 中 ， 大 部 分 组 件 既 发 布 信 
奶 也 订阅 其 他 组 件 发 布 的 信息 。 现 存 多 种 发 布 / 订 阅 
中 间 件 解决 方案 ， 机 器 人 中 常用 的 是 RTI 公司 的 DDS 
(数据 分 布 式 服务 ) ， 以 前 叫 NDDS (网 络 数据 分 布 式 
服务 )““” 。 另 一 种 常用 的 发 布 /订阅 范 型 是 卡 内 基 梅 
隆 大 学 开发 的 IPC“”。 很 多 发 布 /订阅 协议 都 使 用 
XML 《扩展 标识 语言 ) 定义 发 布 的 数据 ， 以 图 通过 
HTTP 传输 XML 的 便利 性 ， 这 样 便 人 允许 基于 Web 的 
应 用 程序 之 间 的 互 操作 。 发 布 / 订 阅 协 议 有 一 个 很 大 
的 优点 是 简单 易 用 且 开 销 低 。 当 不 知道 有 多 少 组 件 需 
要 一 个 数据 块 时 (如 多 用 户 接 口 ) 发 布 /订阅 协议 就 
特别 有 用 了 。 表 有， 组 件 也 不 会 被 陷入 到 对 许多 不 同 
来 源 的 信息 重复 请 求 的 困境 之 中 。 发 布 /订阅 协议 通 
常 很 难 调试 ， 因 为 消息 的 语法 经 常 隐藏 在 一 个 简单 的 
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字符 串 类 型 中 ， 往 往 都 是 到 运行 时 组 件 尝试 解析 一 个 
接收 到 的 消息 失败 时 间 题 才能 暴露 出 来 。 发 布 /订阅 
协议 在 用 于 由 一 个 模块 向 另 一 个 模块 发 送 命令 时 可 读 
性 也 不 好 ， 命 令 不 是 调用 显 式 的 方法 或 函数 (ee 
数 ) ， 而 是 通过 发 布 消息 的 方式 发 出 ， 消 息 中 包含 命 
令 和 参数 ， 这 些 消息 由 订阅 者 去 解析 。 最 后 ， 发 布 / 
订阅 协议 常用 单一 的 中 央 服 务 器 给 所 有 订阅 者 分 发 消 
B, ATE SARC Se] 

3. JAUS 

近年 来 ,在 国防 机 器 人 技术 领域 浮现 出 一 套 标 
准 ， 不 仅 对 通信 协议 作 了 规范 ， 而 且 对 经 由 通信 协议 
传递 的 消息 的 定义 也 作 了 规范 。JAUS (无 人 系统 联 
全 体系 结构 ) 定义 了 一 套 可 重用 的 消息 与 接口 ， 可 
用 在 命令 日 主 系 统 上 “““ 。 这 些 可 重用 的 组 件 降 低 
了 将 新 的 硬件 组 件 集成 到 自主 系统 中 的 开销 。 可 重用 
技术 还 允许 把 为 一 套 自主 系统 开发 的 组 件 拿 到 另 一 套 
自主 系统 上 去 用 。JAUS 有 两 个 组 件 : 一 个 领域 模型 
和 一 个 参考 体系 结构 。 领 域 模型 是 无 人 系统 功能 与 信 
县 的 表示 ， 包 含 对 系统 功能 和 信息 能 力 的 描述 。 前 者 
包括 系统 的 机 动 、 导 航 、 感 知 、 人 负载 和 操作 等 能 力 的 
模型 ， 后 者 包括 系统 的 内 部 数据 模型 ， 如 地 图 和 系统 
状态 。 人 参考 体系 绊 构 提供 一 个 明确 定义 的 消息 集 ， 这 
些 消 息 引 发 动作 的 执行 、 消 息 的 交换 和 事件 的 触发 。 
JAUS 系统 中 发 生 的 每 件 事 情 都 是 由 消息 触发 的 ， 这 
种 策略 使 得 JAUS 称 为 一 种 基于 组 件 的 、 消 息 传 递 式 
的 体系 结构 。 

JAUS 参考 体系 结构 定义 了 系统 的 层次 (如 图 
8.7 所 示 ) ， 层 次 拓扑 将 系统 定义 为 实现 机 器 人 全 部 
能 力 所 必 有 需 的 机 器 人 本 体 、 操 作 控制 单元 (OCU) 
和 基础 结构 的 集合 。 系 统 中 的 子 系统 是 一 些 独 立 的 单 
元 《如 机 器 人 本 体 或 OCU)。 节 点 定义 体系 结构 中 各 
种 处 理 能 力 并 将 JAUS 消息 路 由 到 组 件 。 组 件 提供 各 
种 执行 能 力 并 直接 响应 命令 消息 。 组 件 可 是 传感器 
(如 SICK 激光 传感器 或 视觉 传感器 ) 、 执 行 器 (如 操 
作 机 构 或 运动 机 构 ) 或 机 载 设备 (如 武器 或 任务 传 
感 器 )， 所 谓 拓扑 (特定 系统 、 子 系统 、 节 点 和 组 件 
的 布局 ) 是 在 系统 实现 时 根据 任务 需求 确定 的 。 

JAUS 的 内 核 是 一 个 明确 定义 的 消息 集合 。JAUS 
支持 的 消息 类 型 有 : DMS: 引起 模式 改变 或 启动 动 
YE. QE: 用 于 从 组 件 中 请 求 信息 。 久 告知 ; 响应 
查询 。 人 事件 设置 : 传递 参数 以 对 事件 进行 设置 。 
纪事 件 通知 : 当时 间 发 生 时 发 送 通知 。 

JAUS 有 大 约 30 条 预定 义 消 息 可 供 机 器 人 控制 之 
用 。 有 控制 机 器 人 本 体 的 消息 ， 如 “全 局 向 量 驱 动 
器 消息 ”执行 移动 机 器 人 期 望 全 局 首 向 、 高 度 和 速度 
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的 闭环 控制 。 也 有 传感器 消息 ， 如 “全 局 位 姿 传 感 
器 消息 ”发 布 机 器 人 本 体 的 全 局 位 置 和 朝向 数据 。 
JAUS 中 还 有 操作 消息 ， 如 “设置 关节 位 置 消 息 ” 会 
设置 预期 的 关节 位 置 值 ,“ 设 置 工具 点 消息 ”会 在 末 
端 执行 器 的 坐标 系统 中 设 定 末 端 执行 器 工具 点 的 
坐标 。 

JAUS 也 有 用 户 自 定义 消息 ， 由 消 县 头 和 跟随 的 
特定 格式 构成 ， 其 中 包含 消息 类 型 、 目 的 地 址 (如 
系统 、 子 系统 、 节 点 和 组 件 ) 、 优 先 级 等 。 虽 然 JAUS 
主要 是 点 对 点 的 ，JAUS 消息 也 可 以 打上 广播 标记 分 
发 到 所 有 组 件 。JAUS 还 为 导航 和 操作 定义 了 坐标 系 
统 以 确保 所 有 组 件 能 知悉 发 送 给 它们 的 坐标 。 


行为 控制 


行为 控制 在 机 器 人 体系 结构 中 表示 控制 的 最 底 级 
别 ， 它 直接 连接 传感器 与 执行 器 。 尽 管 这 些 行为 控制 
大 多 都 是 用 C 或 C+ + 语言 手工 写成 的 隧 数 ,但 人 们 
还 是 开发 了 一 些 行为 控制 专用 语言 ， 包 括 ALFA! | 
行为 语言 “1 和 Rext*%”。 传 统 的 控制 理论 (如 PID 
PA. Kalman 滤波 器 等 ) 也 归于 这 一 级 。 在 如 3T 这 
样 的 体系 结构 中 ,行为 层 像 Brooks 机 一 样 运行 ， 亦 
即 由 少数 几 个 能 感知 环境 并 执行 机 器 人 动作 的 行 
(也 称 技能 ) 构成 。 

1. 实例 

下 面 来 看 一 个 在 办 公 楼 中 工作 的 投递 机 器 人 ， 其 
行为 控制 层 包 含 了 在 楼 中 移动 并 执行 投递 任务 所 必需 
的 控制 功能 。 假 定 此 机 器 人 已 知 该 楼 地 图 ,那么 ， 它 
可 能 包含 如 下 行为 ; 由 避 障 移动 到 一 个 位 置 ; OR 
沿 着 走廊 移动 ; @ 找 到 一 扇 门 ，@ 找 到 门 把 手 ; OM 
住 门 把 手 ; @ 近 开门 把 手 ; @ 从 门 通过 ; OREM 
Z, @ 查 看 门牌 号 ; Wik WIS. 

上 述 每 个 行为 都 将 传感器 (视觉 、 距 离 感 知 等 ) 


8. 3.2 
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图 8.7 JAUS 参考 体系 结构 拓扑 ( 引 自 JAUS 参考 体系 结构 文档 [561 ) 


与 执行 项 (轮子 马 达 、 操 作 马 达 等 ) 紧密 联系 在 一 
个 反射 环 中 。 在 如 包容 结构 这 样 的 体系 结构 中 ， 所 有 
行为 都 在 一 个 分 层 控制 方案 中 并 发 运行 ， 其 中 某 些 行 
为 会 受到 抑制 。 在 AURA? 中， 行为 由 势 函 数组 合 
而 成 。 其 他 体系 结构 “*%1 则 使 用 显 式 的 仲裁 机 制 从 
潜在 的 冲突 行为 中 进行 选择 执行 。 

fein 3T? ”| 这样 的 体系 结构 中 ， 并 不 是 所 有 的 
行为 都 同时 处 于 活动 状态 。 典 型 地 ， 只 有 少数 不 冲突 
的 行为 才能 同时 处 于 活动 状态 (如 上 例 中 的 行为 2 
M9). WITE (08.3.3 节 ) 的 职责 是 激活 或 者 抑 
制 行为 以 完成 高 级 任务 并 避 倪 两 个 行为 竞争 同一 资源 
(如 一 个 执行 器 ) 的 冲突 。 

2、 情 境 行为 

这 些 行为 有 一 个 重要 特点 就 是 情境 性 ， 也 就 是 说 
每 个 行为 仅 在 其 特定 的 场景 中 工作 。 例 如 ， 上 述 的 行 
为 @ 是 沿 着 走廊 移动 ， 但 此 行为 仅 当 机 器 人 身 处 走廊 
时 才 适 用 。 类 似 地 ,行为 @) 抓 住 门 把 手 ， 也 仪 当 机 器 
人 处 于 能 抓 到 门 把 手 的 距离 范围 内 时 才 适 用 。 将 机 器 
人 放 在 某 一 情境 时 此 行为 会 没有 反应 ， 但 它 能 识别 出 
该 情境 是 不 适合 的 ， 也 能 看 出 信号 是 不 对 的 。 

3. 失败 觉察 

对 行为 的 一 项 关键 要 求 是 它们 在 不 工作 的 时 候 应 
该 能 觉察 到 ， 这 称 为 失败 觉察 由” 。 例 如 ， 实 例 中 的 
FAO 〈 抓 住 门 把 手 ) 抓 一 次 失败 后 就 不 应 该 在 空 
气 中 连续 及 抓 ， 或 者 更 简单 地 说 ， 不 能 在 撞 了 南 墙 后 
还 不 回头 。 早 期 的 包容 机 器 人 有 一 个 共性 的 问题 ， 即 
行为 不 知道 已 经 失败 而 还 在 继续 采取 动作 ， 结 果 目 然 
没有 进展 。 在 失败 的 情况 下 决策 该 做 什么 不 是 行为 层 
的 任务 ， 行 为 层 只 需要 宣告 行为 失败 、 停 止 活动 。 

4. 实现 约束 

行为 控制 层 设 计 的 主要 目的 是 让 机 器 人 控制 能 实 
现 包 容 结构 的 快速 性 和 反应 性 。 为 此 ， 行 为 控制 层 的 
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行为 需要 遵循 包容 结构 的 套路 ， 尤 其 行为 使 用 的 算法 
要 受 状态 和 时 间 复 杂 度 的 约束 。 在 行为 控制 层 应 该 很 
少 有 或 者 没有 搜索 过 程 ， 很 少 有 和 迭代 运算 。 行 为 应 该 
就 是 简单 的 传递 函数 ， 从 传感器 或 者 其 他 行为 输入 信 
号 ， 向 执行 器 或 者 其 他 行为 输出 信和 号， 每 秒 重复 这 些 
动作 震 干 次 ， 这 样 在 面 对 环 境 改 变 时 才能 表现 出 反应 
性 。 争 议 较 多 的 是 在 行为 层 究 竟 设 置 多 少 个 状态 为 
Fo Brooks 几 年 前 有 一 个 非常 经 典 的 说 法 “最 好 以 世 
界 本 身 作 为 模型 ”“”“ ， 也 就 是 说 ， 机 器 人 无 需 维护 
和 查询 环境 的 内 部 模型 ， 取 而 代 之 的 是 直接 感知 环境 
以 获取 数据 。 诸 如 地 图 、 模 型 等 状态 在 三 层 体 系 结构 
中 均 包 含 在 高 层 中 而 不 在 行为 控制 层 中 。 有 些 例外 情 
况 〈 如 维护 数据 滤波 计算 的 状态 ) 则 具体 问题 具体 
分 析 。Gat “认为 行为 层 保持 的 任何 状态 都 应 该 是 
短暂 的 、 有 限 的 。 


8.3.3 执行 


执行 层 是 行为 控制 层 (数值 运算 ) 与 规划 层 
(符号 运算 ) 之 间 的 接口 。 执 行 层 负责 将 高 级 规划 翻 
译 成 低级 行为 、 在 适当 的 时 候 调 用 行为 、 监 测 执行 并 
处 理 异 常 。 有 些 执行 层 也 分 配 资源 并 监测 其 使 用 情 
况 ， 尽 管 这 些 任 务 从 功能 上 大 多 是 该 由 规划 层 执 
行 的 。 

1. 实例 

继续 以 办 公 室 投递 机 右 人 为 例 。 其 高 级 任务 主要 
是 把 邮件 投递 到 一 个 指定 的 房间 ， 执 行 层 将 此 任务 分 
解 成 一 个 子 任务 集 。 它 可 能 使 用 几何 规划 器 来 确定 要 
走 过 的 走 麻 和 要 转弯 的 路 口 序 列 ， 如 果 沿 线 有 门口 ， 
则 还 会 插入 一 个 任务 去 打开 并 穿 过 此 门 。 在 最 后 一 段 
走廊 中 ， 执 行 层 还 要 增加 一 个 查看 门牌 号 的 并 发 任 
务 。 最 后 的 子 任务 是 告知 屋 里 的 人 有 信件 ， 同 时 监测 
该 信件 是 否 被 拿 走 。 如 果 过 了 一 段 时 间 信 件 未 被 取 
走 ， 将 触发 一 个 异常 以 调用 一 些 恢 复 性 动作 ， 可 能 是 
冉 次 告知 ， 可 能 是 检查 是 否 走 对 屋 了 ， 也 可 能 是 通知 
规划 器 稍 后 重新 调度 投递 任务 。 

2. 能 力 

上 例 中 描述 了 很 多 执行 层 的 能 力 。 一 开始 ， 执 行 
层 就 将 高 级 任务 (目标) 分 解 成 低级 任务 (行为 ) ， 
这 典型 的 做 法 就 是 以 过 程 的 方式 来 完成 。 尽 管 有 时 执 
行 层 也 可 以 使 用 专门 的 规划 技术 ， 如 上 例 中 使 用 的 路 
线 规划 器 ,但 被 编码 在 执行 器 中 的 知识 一 般 还 是 直接 
描述 如 何 完成 任务 ， 而 不 是 先 描 述 需 要 做 什么 再 由 执 
行 层 自己 规划 出 怎么 做 。 典 型 的 分 解 是 一 棵 分 层 的 任 
务 树 ， 如 图 8. 8 所 示 ， 任 务 树 的 时 节点 是 行为 的 参数 
化 调用 。 











> 位 FOOD | 


( 圆 角 椎 为 内 部 节点 ， 甜 形 为 叶子 节点 ， 六 角形 节点 为 执行 
监测 器 ， 实 线 箭头 是 父子 节点 关系 ， 虚 线 箭头 是 时 序 约束 ) 


图 8.8 邮件 投递 任务 的 分 层 任务 树 


除了 将 任务 分 解 成 子 任 务 ， 执 行 层 还 要 在 任务 之 
闻 添 加 和 维护 时 间 约 束 ， 通 常 只 在 同一 层 任务 之 间 才 
加 ， 但 也 有 一 些 执 行 层 语 言 允许 在 任意 任务 对 之 间 加 
上 时 间 约 束 。 最 常见 的 约束 是 串 行 和 并 发 ， 但 大 多 数 
执行 层 支 持 更 有 表现 力 的 约束 语言 ， 如 一 个 任务 要 在 
男 一 个 任务 开始 10s 后 开始 ， 或 者 一 个 任务 要 在 另 一 
个 任务 结束 时 结束 。 

当 任 务 的 时 间 约 束 条 件 满足 时 ， 执 行 层 负责 派发 
这 些 任务 。 在 有 些 执行 层 中 ,任务 也 可 以 指定 资源 ， 
如 机 带 人 的 马达 或 者 摄像 机 ， 这 些 资 源 在 任务 被 派发 
前 必须 可 用 。 和 行为 一 样 ， 在 冲突 的 任务 之 间 进 行 仲 
裁 也 是 一 个 问题 。 但 在 执行 屋 中 ， 这 种 仲裁 要 么 显 式 
地 编程 实现 (如 用 规则 规定 机 器 人 在 试图 避 障 而 偏 
离 首 选 路 线 的 情况 下 该 做 什么 ) ， 要 么 采用 优先 级 来 
处 理 (如 充电 比 投递 邮件 更 重要 )。 

执行 层 的 最 后 两 个 重要 的 能 力 是 执行 监测 和 错 
RRR. AAMT HES RE, IRE MIT A ABABA OY SE 
了 ,还 要 这 些 能 力 干 什么 ? 原因 有 二 : H-—, w 
8.3.2 TATE, 行为 是 具有 情境 性 的 ， 而 情境 会 不 
可 预期 的 变化 ， 例 如， 实现 一 个 行为 时 可 以 假定 有 
人 能 取 走 邮件 ,但 是 事实 未 必 总 是 如 此 ; 其 二 ,要 
试图 达到 某 些 目标 ， 行 为 层 可 能 会 将 机 器 人 移动 到 
一 个 执行 层 无 法 预期 的 状态 ， 例 如 ， 人 们 可 以 利用 
机 器 人 的 避 障 行为 将 机 器 人 赶 到 厕所 里 。 尺 管事 实 
上 行为 层 可 以 在 这 样 的 情境 中 保持 机 器 人 的 安全 ， 
但 执行 层 还 是 需要 对 情境 进行 检测 ， 以 便 使 机 器 人 
回 到 原来 的 路 线 上 。 

典型 地 ， 执 行 监测 被 实现 成 并 发 任务 ， 或 者 直接 
分 析 传 感 器 数据 ， 或 者 在 监测 的 情境 出 现时 激活 一 个 
行为 向 执行 层 发 送信 号 ， 这 些 分 别 对 应 轮 询 与 中 断 驱 
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动 两 种 监测 方式 。 

执行 层 支持 被 触发 的 对 监测 器 的 各 种 响应 。 监 测 
器 可 以 生成 子 任务 来 处 理 某 个 情境 ， 它 可 以 终止 已 经 
生成 的 子 任务 ， 可 以 引起 父 任务 的 失败 ， 或 者 也 可 以 
产生 一 个 异常 。 后 两 种 响应 涉及 错误 恢复 (也 称 异 
常 处 理 ) 能 力 。 很 多 执行 层 要 求 任务 返回 状态 值 
(成 功 或 失败 )， 并 人 允许 父 任务 基于 返回 值 有 条 件 地 
执行 。 还 有 一 些 执行 层 使 用 分 层 异 常 机 制 抛 出 命名 异 
常 以 定位 在 任务 树 中 的 节点 。 最 近 的 注册 了 该 异常 处 
理 器 的 子 任务 会 尝试 处 理 这 个 异常 ， 如 果 处 理 不 了 ， 
它 会 将 此 异常 向 任务 树 的 上 一 层 再 次 抛 出 。 这 种 机 制 
是 受 C+ +, Java 和 Lisp 的 异常 处 理 机 制 启发 而 来 
的 ， 它 比 返 回 值 机 制 更 具有 表达 能 力 ， 但 由 于 控制 流 
的 非 局 部 性 特点 ， 使 得 采用 这 种 方法 设计 系统 的 难度 
要 大 得 多 。 

3. 实现 约束 

大 多 数 执行 层 的 主要 形式 是 分 层 有 限 状 态 控 制 右 。 
Petri 网 "1 常用 来 表示 执行 层 函 数 。 上 此外， 人们 还 开发 
了 各 种 语言 专门 来 辅助 程序 员 实 现 执 行 层 的 各 种 能 力 。 
我 们 就 几 个 方面 扼要 讨论 一 下 以 下 几 种 语言 : 反应 动作 
fl, (RAP)B421 、 过 程 推理 系统 (PRS) OO! | BAT Se 
持 语 言 〈《ESL)E21 、 任 务 描述 语言 (TDL)"”” 和 规 
划 执 行 交 换 语 言 (PLEXIL) E", 

这 些 语言 既 有 共性 ， 又 有 不 同 。 区 别 之 一 ， 语 言 
是 独立 的 《RAP、PRS、PLEXIL〉 还 是 现 有 语言 的 扩 
Fe (ESL 是 通用 Lisp 的 扩展 ，TDL 是 C+ + 的 扩展 ) 。 
独立 语言 总 是 易于 分 析 和 验证 的 ， 但 扩展 语言 灵活 性 
更 好 ， 尤 其 与 已 有 软件 集成 时 更 见 优势 。 尽 管 独立 的 
执行 层 语 言 也 都 支持 用 户 自 定义 函数 接口 ， 但 这 些 接 
口 在 能 力 上 (如 都 有 什么 类 型 的 数据 结构 可 以 传递 ) 
往往 是 有 限 的 。 

所 有 这 些 执行 层 语言 都 对 任务 到 子 任务 的 分 层 分 
解 提 供 支 持 。 除 PLEXIL 外 所 有 语言 都 允许 任务 的 北 
归 调 用 。RAP、TDL 和 PLEXIL 在 语法 上 能 区 别 任务 
树 (图 ) 的 叶 节 点 和 内 部 节点 。 

所 有 语言 都 提供 了 表示 条 件 和 人 迭代 的 能 力 ， 尽 管 
在 RAP 和 PLEXIL 中 这 些 不 是 核心 语言 结构 ， 而 必须 
通过 其 他 结构 的 组 合 来 表示 。 除 了 TDL， 这 些 语言 
对 任务 的 前 提 条 件 和 后 续 条 件 的 编码 以 及 成 功 条 件 的 
指定 提供 显 式 的 支持 。 在 TDL 中 ， 这 些 概 念 必须 用 
更 基本 的 结构 编程 实现 。 独 立 语言 都 允许 在 任务 描述 
中 定义 局 部 变量 ， 但 对 这 些 变量 仅 提 供 有 限 的 计算 处 
理 。 显 然 ， 在 扩展 语言 中 ， 其 基础 语言 的 全 部 能 力 都 
可 以 用 来 定义 任务 。 

所 有 语言 支持 任务 间 简 单 的 串 行 ( 序 列 ) 的 和 


并 发 (GA) 的 时 序 约束 ， 也 支持 超时 设 定 ， 在 等 
待 指定 的 一 段 时 间 后 触发 。 此 外 ，TDL 直接 支持 宽 范 
围 的 时 序 约束 一 一 可 以 在 任务 的 开始 和 结束 之 间 设 定 
约束 (如 ,任务 B 在 任务 A 开始 后 开始 ， 或 任务 C 
在 任务 D 开始 后 结束 )， 也 可 以 指定 度量 约束 (如 ， 
任务 B 在 任务 A 结束 10s 后 开始 ， 或 任务 C 在 下 午 
1; 00 开始 ) ESL 和 PLEXIL 支持 事件 ( 如 任务 转移 
到 新 状态 时 ) 信 令 ， 可 以 类 似 地 实现 约束 的 表示 类 
型 。 此 外 ，ESL A TDL 支持 基于 事件 发 生 的 任务 终 
止 ， 如 当 任 务 A 开始 时 任务 BAIL. 

在 异常 监测 和 异常 处 理 方面 ， 各 种 语言 有 着 不 同 
的 考虑 。ESL 和 TDL 都 提供 显 式 的 异常 监测 结构 ， 
并 支持 抛 出 异常 和 由 注册 处 理 器 捕获 异常 的 分 层 处 理 
方式 。 这 种 异常 处 理 方式 与 C+ + Java 和 Lisp 中 使 
用 的 方式 类 似 。ESL 和 TDL 也 支持 清除 过 程 ， 在 任 
务 终止 时 可 以 调用 。RAP 和 PLEXIL 并 没有 分 层 异常 
处 理 机 制 ， 而 是 使 用 返回 值 来 指示 失败 。 但 PLEXIL 
支持 清除 过 程 ， 当 任务 失败 时 运行 该 过 程 。PRS 支持 
执行 监测 ， 但 不 支持 异常 处 理 。ESL 和 PRS 支持 资源 
共享 ， 并 都 对 自动 阻止 任务 间 到 资源 的 连接 提供 支 
持 。 在 其 他 执行 语言 中 ， 这 项 功能 是 需要 分 别 实现 
的 ， 尽 管 有 规划 在 这 方面 扩展 PLEXIL, 

最 后 ，RAP、PRS 和 ESL 均 包 含 符 号 数据 库 〈( 环 
境 模型 ) ， 该 数据 库 或 者 直接 连接 传感器 或 者 连接 行 
为 层 以 保持 与 真实 环境 的 同步 。 通 过 数据 库 查 询 可 以 
确定 前 提 条 件 是 否 为 真 、 哪 种 方法 可 用 等 。PLEXIL 
使 用 查找 表 实 现 类 似 的 功能 ,不 过 它 的 实现 方式 
(比如 ， 是 通过 数据 库 查 找 还 是 通过 调用 行为 层 隔 
数 ) 对 任务 是 透明 的 。TDL 则 将 这 项 工作 留 给 了 程 
序 员 ， 由 程序 员 来 确定 这 些 任务 如 何 与 环境 进行 
关联 。 


8. 3. 4 





规划 


分 层 结构 中 的 规划 组 件 负责 根据 高 级 目标 确定 机 
器 人 的 长 远 活动 计划 。 行 为 控制 组 件 关注 的 是 眼皮 底 
下 的 事 儿 ， 执 行 组件 关 注 的 是 刚刚 发 生 的 和 即将 发 生 
的 事 儿 ， 而 规划 组 件 则 是 面向 未 来 的 。 在 办 公 室 投递 
机 器 人 的 实例 中 ， 规 划 组 件 要 考虑 一 天 的 投递 、 机 器 
人 的 资源 、 地 图 、 确 定 最 优 投递 路 线 和 调度 ， 包 括 机 
器 人 什么 时 候 应 该 充电 。 当 情境 改变 时 ， 规 划 组 件 也 
人 负责 重新 规划 。 例 如 ， 如 果 赶 上 办 公 室 锁 门 ， 规划 组 
件 将 确定 一 个 新 的 投递 计划 ， 而 将 锁 门 办 公 室 的 投递 
任务 安排 到 当天 稍 晚 些 时 候 。 

1. 规划 类 型 

第 9 章 将 详细 描述 机 器 人 规划 的 方法 ， 本 章 概述 
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与 规划 器 不 同类 型 有 关 的 一 些 问题 ， 因 为 它们 都 与 分 
层 结 构 有 关 。 

最 常用 的 两 种 方法 是 分 层 任务 网 (HTN) 规划 
器 和 规划 器 /调度 器 。HTN 规划 器 中 ?2.3 将 任务 分 解 
成 子 任务 ， 其 分 解 方式 与 执行 层 类 似 。 主 要 的 不 同 
xe, HTN 规划 器 总 是 在 较 高 的 抽象 级 别 进行 操作 、 
会 考虑 到 资源 的 利用 且 具 有 处 理 任务 间 冲 突 的 方法 ， 
如 ， 多 个 任务 需要 相同 的 资源 ， 或 者 一 个 任务 否定 了 
另 一 个 任务 所 需 的 前 提 条 件 。HTN 规划 器 所 需 的 知识 
通常 相当 容易 确定 ， 因 为 它 直 接 指明 任务 如 何 完 成 。 

规划 器 /调度 器 “5 在 时 间 和 资源 有 限 的 领域 
很 有 用 。 它 们 创建 高 级 规划 ， 在 任务 应 该 发 生 时 进行 
调度 ， 但 通常 留 给 执行 层 去 确定 具体 如 何 实现 任务 。 
规划 器 /调度 器 的 工作 通常 是 将 任务 布置 在 时 间 线 上 ， 
对 机 器 人 上 可 用 的 各 种 资源 (如 马达 、 电 力 、 通 信 
等 ) 分 别 采 用 不 同 的 时 间 线 。 规 划 器 /调度 器 所 需 的 
知识 包括 任务 要 完成 的 目标 、 所 需 的 资源 、 持 续 时 间 
和 任务 间 的 约束 。 

很 多 体系 结构 提供 专门 的 规划 专家 系统 ， 能 高 效 
地 求解 特定 的 问题 ， 特 别 地 ， 还 包括 运动 规划 器 ， 如 
路 径 规 划 器 和 轨迹 规划 器 。 有 时 ,体系 结构 的 规划 层 
直接 调用 这 些 专门 的 规划 器 ， 而 在 其 他 体系 结构 模式 
中 ， 运 动 规划 器 是 体系 结构 中 较 低 层 (执行 层 甚 至 
行为 层 ) 的 一 部 分 。 把 这 些 专门 的 规划 器 放 在 哪儿 
通常 属于 选 型 问题 或 者 性 能 问题 (参见 8.5 节 )。 

此 外 ， 有 些 体 系 结构 提供 多 个 规划 展 呈 ?46 。 
通 癌 ， 最 顶层 有 一 个 使 命 规划 层 ， 它 在 很 抽象 的 层次 
上 对 相对 较 长 的 一 段 时 间 进 行规 划 。 这 层 主 要 负责 选 
择 在 下 一 段 时 间 内 要 实现 哪个 高 级 目标 〈 并 且 有 时 
需要 确定 按 什么 顺序 实现 这 些 目标 ) ， 以 最 大 化 某 个 
目标 函数 ， 如 净 和 县 利 。 稍 低 一 些 的 任务 规划 层 负 责 确 
定 怎样 和 何 时 完成 每 个 目标 。 这 样 细 分 通常 是 出 于 对 
效率 的 考虑 ， 因 为 同时 进行 既 长 期 又 细致 的 规划 是 很 
困难 的 。 

2. 规划 与 执行 的 集成 

在 机 虽 人 体系 结构 中 将 规划 与 执行 组 件 集成 到 一 
起 有 两 种 主要 方法 。 一 种 方法 是 规划 组 件 由 执行 组 件 
按 需 调用 ， 并 返回 一 个 规划 ， 然 后 规划 组 件 进入 休眠 
状态 ， 直 到 再 次 被 调用 。ATLANTIS A 38 es 
Agent“ ”等 体系 结构 都 使 用 这 种 方法 ， 这 要 求 执行 
组 件 要 么 给 规划 组 件 留 下 足够 的 时 间 完 成 规划 ， 要 么 
在 规划 完成 前 对 系统 的 安全 负责 。 例 如 ， 在 遥控 A- 
gent 中 ， 会 显 式 调度 一 个 专门 的 规划 任务 。 第 二 种 方 
法 是 规划 组 件 根 据 需 要 将 高 级 任务 向 下 发 送 到 执行 组 
件 ， 并 监测 这 些 任务 的 进展 情况 。 如 果 任 务 失 败 ， 则 





立即 重新 规划 。 在 这 种 方法 中 ， 规 划 组 件 始 终 运 行 ， 
并 一 直 进行 着 规划 、 重 规划 。 信 号 必须 在 规划 器 和 执 
行 组 件 之 间 实 时 传递 以 使 它们 保证 同步 。 如 3T 
等 体系 结构 采用 的 就 是 第 二 种 方法 。 第 一 种 方法 在 系 
统 处 于 相对 静态 的 环境 时 适用 ， 规 划 次 数 很 少 ， 相 对 
可 预期 。 第 二 种 方法 更 适用 于 动态 环境 ， 重 规划 很 频 
繁昌 难以 预期 。 

在 规划 与 执行 集成 时 还 需要 做 的 决策 是 到 何 时 停 
止 任 务 分 解 、 在 何 处 监测 规划 执行 以 及 如 何 处 理 异 
常 。 如 果 一 直 规划 到 基本 动作 或 行为 ， 规 划 器 对 于 执 
行 期 间 将 会 发 生 什 么 会 有 很 好 把 握 ， 但 这 是 以 更 多 的 
计算 为 代价 的 。 再 有 ， 有 些 任 务 分 解 很 容易 进行 过 程 
fk RAHNER), MIE HHR (EMARE 
a) PÆ, ， 热 行 层 的 监测 效率 更 高 些 ， 因 为 监测 点 
徘 近 机 器 人 的 传感器 ， 而 规划 器 可 能 会 利用 更 多 的 全 
局 知识 更 早 和 (或 ) 更 精确 地 检测 到 异常 。 关 于 处 
理 异常 ， 执 行 层 自 己 能 够 处 理 很 多 异常 ， 其 代价 只 是 
破坏 了 规划 器 在 调度 任务 时 的 预期 结果 ， 而 男 一 方 
面 ， 若 由 规划 器 处 理 异 常 通常 会 涉及 到 重 规划 ， 其 计 
算 代 价 是 高 昂 的 。 

然而 ， 对 于 所 有 这 些 集成 问题 通常 有 一 种 折 中 方 
案 。 例 如 ， 可 以 只 将 某 一 部 分 任务 进行 更 深层 次 的 分 
解 ; 或 者 一 部 分 异常 放 在 执行 层 处 理 ， 而 另 一 部 分 异 
常 交 由 规划 器 处 理 。 一 般 来 讲 ， 恰 当 的 方法 都 需要 折 
中 考虑 ， 并 需要 具体 问题 具体 分 析 (参见 8.5 节 )。 


案例 研究 


本 节 介 绍 一 个 相当 复杂 的 自主 移动 机 器 人 的 体系 
结构 。 机 器 人 GRACE (Graduate Robot Attending Con- 
ference， 出 席 会 议 的 研究 生机 器 人 ) 是 5 家 研究 机 构 
( 卡 内 基 梅 隆 大 学 、 海 军 研究 实验 室 、 西 北大 学 、 
Metrica 公司 和 Swarthmore 学 院 ) 共同 努力 的 成 果 ， 
设计 用 于 参加 AAAI (美国 人 工 智能 学 会 ) 的 机 器 人 
挑战 赛 。 挑 战 赛 要 求 机 器 人 作为 与 会 者 参加 AAAI 举 
办 的 全 国人 工 智能 大 会 ， 机 器 人 必须 要 找到 注册 台 
《预先 不 知道 会 议 中 心 的 布置 ) ， 并 注册 会 议 ， 然 后 
根据 会 议 提供 的 地 图 找到 路 线 并 及 时 到 达 指 定 地 点 进 
行 技术 交流 。 

在 给 定 了 任务 的 复杂 性 和 技术 集成 的 需求 后 ， 机 
名 人 的 体系 结构 设计 尤为 重要 。 这 些 技 术 已 由 上 述 5 
家 机 构 先 期 开发 过 ， 包 括 动态 环境 中 的 定位 、 在 行人 
面前 的 安全 导航 、 路 径 规 划 、 动 态 重 规划 、 人 体 视 党 
跟踪 、 告 示 牌 、 标 记 、 手 势 和 人 脸 的 识别 、 语 音 识 别 
与 自然 语言 理解 、 语 音 合 成 、 知 识 表 示 以 及 与 人 社交 


8. 4 GRACE 








第 8 章 机 器 人 体系 结构 与 程序 设计 161 


等 技术 。 

GRACE 以 RWI (Real World Interface) © 的 B21 
机 器 人 为 基础 ， 配 有 一 个 由 平板 液晶 显示 融 (LCD) 
显示 的 表情 丰富 的 计算 机 动画 人 脸 (如 图 8.9 所 
示 ) 。B21 上 配备 触觉 、 红 外 和 声 纳 等 传感器 ， 最 靠 
近 底 座 的 是 一 个 SICK 激光 扫描 测 距 仪 ,具有 180 JE 
的 视野 。 此 外 ，CRACE 还 装配 了 几 台 摄像 机 ， 包 括 
一 台 由 Metrica TRACLabs 制造 的 云 台 立体 摄像 机 、 一 
台 Canon 产 的 云 台 变焦 单 色 摄像 机 。GRACE 借助 高 
品质 语音 合成 软件 Festival 讲话 ， 使 用 无 线 耳 麦 
(Shure TC 的 计算 机 无 线 收 发 套件 ) 接收 语音 信息 。 





图 8.9 机 器 人 GRACE 
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GRACE 体系 结构 的 行为 层 由 一 些 控 制 特定 硬件 
部 件 的 独立 进程 构成 ， 这 些 程序 提供 抽象 接口 ， 或 用 
于 硬件 控制 ,或 用 于 从 传感器 返回 信息 。 为 了 使 用 各 
种 设备 不 同 的 编码 类 型 ， 大 部 分 接口 既 支 持 间 步 的 、 
阻塞 的 调用 ， 也 支持 异步 的 、 非 阻塞 的 调用 (对 于 
非 阻塞 调用 ， 接 口 允 许 程 序 员 指定 数据 返回 时 的 回调 
项 数 ) 。 行 为 层 包 括 机 器 人 运动 和 和 定位 〈 也 提供 激光 
测 距 信息 ) 、 语 音 识 别 、 语 音 合成 、 面 部 动画 、 彩 色 
视觉 与 立体 视觉 (如 图 8.10 所 示 ) 等 接口 。 

该 体系 结构 中 对 执行 层 的 每 项 能 力 都 采用 独立 
的 进程 实现 ， 这 么 做 主要 是 由 于 底层 代码 都 是 由 不 
同 公司 开发 的 ， 尽管 让 大 量 进 程 并 发 运行 可 能 会 效 
率 很 低 ， 但 要 想 把 所 有 功能 都 放 在 单个 进程 中 完成 ， 
则 实在 太 难 。 此 外 ， 使 用 分 离 的 进程 还 便于 开发 和 
调试 ， 因 为 每 次 只 需要 与 系统 中 需要 测试 的 部 分 打 
交道 。 

执行 层 由 完成 挑战 赛 每 个 子 任 务 的 独立 程序 构 
成 ,包括 寻找 注册 台 、 乘 电梯 、 排 队 、 与 注册 人 员 交 
流 、 走 到 报告 区 和 作 报 告 ， 如 图 8. 10 所 示 。 与 很 多 
已 实现 的 机 器 人 系统 一 样 ，GRACE 体系 结构 没有 规 
划 层 ， 因 为 这 里 涉及 的 高 级 规划 任务 要 么 是 一 成 不 变 
的 ， 要么 是 很 简单 易 行 的 ， 直 接 编程 即 可 。 有 些 执行 
层 程序 采用 TDL (参见 8.3.3 节 ) 写成 ， 这 样 便于 并 
发 控制 和 各 种 任务 的 监测 。 





面部 动画 


图 8.10 GRACE 的 体系 结构 


O HIE: RWI AAT iRobot 公司 的 一 个 分 部 。 
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寻找 注册 台 是 必 不 可 少 的 一 项 任务 (前 已 述 及 ， 
GRACE 并 不 知道 注册 台 在 哪儿 ， 也 不 知道 会 议 中 心 
长 什么 样 ) GRACE 采用 TDL 构造 了 有 限 状态 机 ， 
这 样 它 就 可 以 维护 多 个 目标 ， 如 利用 电梯 到 达 某 一 楼 
层 、 按 照 指 南 找到 电梯 (如 图 8. 11 所 示 )， 最 顶级 
的 目标 是 找到 注册 台 。 当 GRACE 与 人 交互 拿 到 了 去 
注册 台 的 指南 时 ， 一些 中 间 目 标 就 创建 出 来 了 。 如 果 
没有 指南 可 用 ，GRACE 就 随机 和 逛 一 选 ， 直 到 用 激光 
扫描 仪 探 测 到 人 ， 它 便 会 和 人 交流 以 得 到 指南 。 
GRACE 可 以 处 理 简单 的 命令 ， 如 左 转 、 向 前 Sm, th 
能 处 理 一 些 高 级 指令 ， 如 乘 电梯 、 下 一 路 口 左 转 。 此 
Jh, GRACE 还 会 提问 ， 如 “我 这 是 走 到 注册 台 了 
吗 ?”、“ 这 是 电梯 吗 ?”GRACE 在 各 个 时 刻 都 使 用 基 
F TDL 的 有 限 状态 机 来 确定 如 何 交互 最 恰当 ， 这 样 
可 以 防止 “思维 ”混乱 。 


目的 地 





图 8.11 GRACE 按照 指南 走 到 注册 台 的 有 限 状 态 机 


进程 间 通 信 采 用 IPC Het?) IC 支持 发 
布 /订阅 和 客户 机 /服务 器 两 种 消息 机 制 ， 能 在 进程 
间 透 明 传 递 复杂 的 数据 结构 。 使 用 IPC 进行 进程 间 
通信 的 一 个 好 处 是 能 够 记录 下 所 有 的 消息 通信 信息 ， 
既 能 记录 消息 名 称 ， 也 能 记录 数据 内 容 。 事 实证 明 ， 
有 时 要 弄 清楚 系统 为 什么 没 能 按照 预期 动作 执行 ， 
非 这 些 记 录 不 可 。 是 进程 发 送 了 无 效 数 据 ? 还 是 没 
有 及 时 发 出 消息 ? 是 接收 进程 因 故 阻 蹇 了 ? 还 是 时 
间 上 的 问题 ? 尽管 分 析 这 些 消息 日 志 往 往 令 人 乏味 ， 
但 某 些 时 候 这 也 是 找到 那些 间 砍 性 故障 的 唯一 手段 。 

2002 年 7 月 ，GRACE 成 功 地 完成 了 在 加 拿 大 埃 
fe Se HAY Shaw 会 议 中 心 的 挑战 。 行 为 层 的 进程 总 的 
来 说 是 如 预期 那样 工作 的 ， 这 要 归功 于 这 些 模 块 都 是 


从 以 前 开发 的 系统 中 移植 过 来 的 (也 就 是 说 已 经 过 
很 好 的 测试 )。 而 执行 层 的 进程 在 非 标 称 情境 下 则 
出 了 不 少 问题 。 问 题 主 要 出 在 传 感 数据 的 理解 上 以 
及 对 会 议 中 心 看 起 来 会 是 什么 样 的 错误 假定 ， 例 如 ， 
有 些 隔断 是 玻璃 的 ， 而 激光 传感器 几乎 检测 不 到 。 
不 过 总 而 言 之 ， 该 体系 结构 还 是 不 负 众望 ， 把 一 大 
堆 复 杂 的 软件 相当 快 地 集成 起 来 并 能 高 效 地 一 起 


运行 。 





8.5 机 悄 人 体系 结构 设计 艺术 


设计 机 器 人 体系 结构 说 是 科学 ， 但 更 是 艺术 。 
体系 结构 设计 的 目标 是 使 得 编程 实现 一 个 机 器 人 更 
容易 、 更 安全 、 更 灵活 。 因 而 ， 一 个 机 器 人 体系 结 
构 开 发 者 所 做 的 决策 会 受到 其 个 人 经 验 (如 熟悉 哪 
些 程序 设计 语言 ) 、 机 器 人 与 环境 以 及 要 执行 的 任 
务 等 多 方面 影响 。 体 系 结构 的 选 型 不 可 轻视 ， 因 为 
根据 创造 者 的 经 验 ， 一旦 选 定 体系 结构 ， 那 就 是 多 
少年 都 不 动摇 的 。 改 变 机 器 人 的 体系 结构 是 个 难题 ， 
且 当 大 量 代 码 已 经 实现 时 再 改 体 系 结 构 会 使 开发 进 
BE BIB 

机 器 人 体系 结构 设计 艺术 始 于 设计 者 要 问 的 一 系 
列 问 题 ， 这 些 问题 包括 : 

@ 机 信人 要 执行 什么 任务 ? 是 长 期 任务 还 是 短 
期 任务 ? 是 用 户 发 起 的 还 是 机 器 人 发 起 的 ? 任务 是 重 
复 性 的 还 是 随 着 时 间 总 在 变化 的 ? 

@ 执行 任务 需要 哪些 动作 ? 那些 动作 如 何 表示 ? 
动作 之 间 如 何 协调 ? 执行 时 需要 用 多 快 的 速度 选择 和 
改变 动作 ? 为 了 保证 机 器 人 安全 ， 每 个 动作 以 什么 样 
的 速度 执行 ? 

@ 任务 需要 处 理 什么 数据 ?机 器 人 如 何 从 环境 
或 者 用 户 获 取 数 据 ?” 用 什么 传感器 来 获取 这 些 数据 ? 
数据 如 何 表 示 ? 用 什么 处 理 方法 将 传感器 数据 抽象 成 
体系 结构 内 部 表示 ?数据 所 需 的 更 新 频率 如 何 ? 数据 
能 够 更 新 的 频率 又 如 何 ? 

@ 机 髓 人 需要 什么 样 的 计算 能 力 ? 这 些 计 算 能 
力 要 输出 什么 样 的 数据 ， 又 要 输入 什么 样 的 数据 ? 机 
毅 人 的 这 些 计算 能 力 如 何 进 行 划 分 和 结构 化 处 理 ， 又 
如 何 互 连 ? 计算 能 力 的 最 佳 分 解 (粒度 ) 是 什么 ? 
每 项 计算 能 力 要 对 其 他 计算 能 力 知晓 多 少 ?” 有 可 重用 
《来 目 其 他 机 器 人 或 者 其 他 项 目 等 ) 的 计算 能 力 吗 ? 
不 同 的 计算 能 力 驻 留 在 何 处 (如 板 载 或 者 板 外 )? 

o 机 器 人 的 用 户 是 什么 人 ? 他 们 要 用 机 器 人 做 
什么 ? 他 们 需要 对 机 器 人 的 计算 能 力 有 什么 样 的 理 
解 ? 用 户 怎 么 了 解 机 器 人 在 做 什么 ? 用 户 的 交互 是 对 
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等 的 、 监 管 的 还 是 旁观 性 质 的 ? 

o 如 何 评价 这 个 机 器 人 ? 成 功 的 标准 是 什么 ? 
失败 的 模式 又 有 哪些 ? 如 何 规避 失败 ? 

@ 用 一 种 机 器 人 的 体系 结构 处 理 不 止 一 套 任务 ? 
还 是 用 不 止 一 种 机 器 人 去 处 理 ? 需要 不 止 一 班 开 发 人 
马 吗 ? 

一 旦 设计 者 对 所 有 (或 大 部 分 ) 问题 有 了 答案 ， 
便 可 以 开始 针对 想 让 机 器 人 执行 的 操作 的 类 型 和 想 让 
用 户 如 何 与 之 交互 的 方式 设计 一 些 用 例 。 这 些 用 例 应 
该 详细 说 明 机 器 人 与 环境 和 用 户 有 关 的 外 部 行为 。 从 
这 些 用 例 ， 可 以 逐步 开始 机 器 人 功能 的 初始 划分 。 划 
分 的 同时 应 该 画 出 序列 图 ， 以 便 显示 信息 和 控制 流 随 
着 时 间 推 移 在 机 器 人 体系 结构 各 种 组 件 间 的 传递 情 
况 * 1 。 此 后 ， 可 以 开发 一 个 更 正式 的 体系 结构 组 件 
间 的 接口 规格 说 明 。 这 项 工作 可 以 借助 诸如 CORBA 
的 IDL (接口 定义 语言 ) 这 样 的 语言 来 完成 ， 也 可 以 
采用 发 布 /订阅 协议 定义 要 分 发 的 消息 来 完成 。 这 是 
至 关 重 要 的 一 步 ， 因 为 一 旦 开始 实施 再 想 更 改 ， 代 价 
可 就 大 了 。 如 果 接 口 要 修改 ， 就 要 通知 到 所 有 用 此 接 
口 的 组 件 与 改 后 接口 的 保持 一 致 。 机 器 人 体系 结构 集 
成 时 最 常见 的 问题 是 组 件 预 期 的 数据 与 其 正在 收 到 数 
据 不 匹配 。 

接口 定义 清晰 的 分 层 体系 结构 有 个 好 处 就 是 各 层 
可 以 并 行 开发 。 行 为 控制 层 拿 人 当成 执行 层 就 可 以 开 
始 在 机 器 人 上 实现 和 测试 了 。 执 行 层 采用 状态 机 桩 仿 
模拟 机 器 人 上 的 预期 行为 就 可 以 开始 实现 和 测试 了 。 
这 些 桩 仅仅 是 响应 调用 适时 地 答 个 到 而 已 。 然 后 ， 各 
层 就 可 以 集成 测试 时 序 和 其 他 运行 时 间 题 了 。 只 有 在 
组 件 的 角色 和 接口 都 被 定义 和 考虑 清楚 的 情况 下 ， 这 
种 并 行 方法 才能 加 速 机 器 人 体系 结构 的 开发 进程 。 做 
集成 时 ， 实 时 调试 问题 也 需要 考虑 。 根 据 我 们 的 经 
验 ， 机 器 人 体系 结构 的 大 部 分 开发 时 间 还 是 花 在 行为 
控制 屋 ， 也 就 是 说 ， 与 执行 和 规划 相 比 ， 感 知 和 行动 
依然 是 机 器 人 的 “硬件 ”。 做 出 一 个 良好 的 、 重 棒 的 
行为 控制 层 ， 就 等 于 向 合格 的 机 器 人 体系 结构 迈 出 了 
一 大 步 。 


8.6 结论 与 扩展 阅读 


设计 机 器 人 体系 结构 有 助 于 使 完成 任务 的 行为 并 


O PRE. 状态 机 桩 就 是 一 种 模拟 的 状态 机 的 嚼 数 。 


发 执行 ， 能 让 机 器 人 系统 控制 执行 器 、 解 译 传感器 、 
规划 、 监 测 执行 并 处 理 意 外 事件 和 把 握 良 机 。 体 系 结 
构 给 出 了 领域 相关 的 软件 开发 的 概念 框架 ， 还 常常 提 
供 一 些 编程 工具 以 便于 开发 软件 。 

然而 ， 没 有 万 能 的 体系 结构 。 研 究 人 员 已 经 开 
发 了 各 种 各 样 的 体系 结构 可 用 于 不 同 的 应 用 场合 ， 
但 还 没有 明确 的 规则 能 确定 在 给 定 应 用 场合 下 选 哪 
种 体系 结构 最 适用 ， 本 章 给 出 了 一 些 指导 方针 以 助 
于 开发 人 员 在 工作 中 选择 恰当 的 体系 结构 。 可 以 
说 ， 分 层 体 系 结构 已 经 越 来 越 普 及 ， 这 要 归功 于 
他 们 的 灵活 性 及 其 在 多 个 抽象 级 别 上 同时 操作 的 
能 力 。 

《AI and Mobile Robots) '* 77! 一 书 中 有 若 于 关于 体 
系 结 构 的 章节 (本 章 参考 了 不 少 ) 。 大 多 数 机 器 人 教 
PA 88) 中 都 有 机 器 人 体系 结构 的 章节 。20 世纪 
90 年 代 中 期 ，AAAI 举办 的 人 工 智能 春季 研讨 会 上 连 
续 几 年 都 有 机 器 人 体系 结构 议题 ， 但 该 研讨 会 的 论文 
集 并 未 广泛 发 行 。 关 于 GRACE 的 更 多 信息 可 以 查阅 
参考 文献 [ 8. 82-84}, 


参考 文献 


8.1 |. Jacobson, G. Booch, J. Rumbaugh: The Uni- 
fied Software Development Process (Addison Wesley 
Longman, Reading 1998) 

8.2  J.S. Albus: RCS: A reference model architecture for 
intelligent systems, Working Notes: AAAI 1995 Spring 
Symposium on Lessons Learned from Implemented 
Software Architectures for Physical Agents (1995) 

8.3 R.A. Brooks: A robust layered control system for a 
mobile robot, {EEE J. Robot. Autom. 2(1), 14-23 (1986) 

8.4 RJ. Firby: An Investigation into Reactive Planning 
in Complex Domains, Proc. of the Fifth National 
Conference on Artificial Intelligence (1987) 

8.5 R. Simmons: Structured control for autonomous 
robots, IEEE Trans. Robot. Autom. 10(1), 34—43 (1994) 

8.6 J.J. Borrelly, E. Coste-Maniere, B. Espiau, K. Kapelos, 
R. Pissard-Gibollet, D. Simon, N. Turro: The ORCCAD 
architecture, Int. J. Robot. Res. 17(4), 338-359 (1998) 

8.7 B. Kuipers: The spatial semantic hierarchy, Artif. 
Intell. 119, 191-233 (2000) 

8.8 R. Orfali, D. Harkey: Client/Server Programming with 
JAVA and CORBA (Wiley, New York 1997) 

8.9 R. Simmons, G. Whelan: Visualization Tools for Vali- 
dating Software of Autonomous Spacecraft, Proc. of 
International Symposium on Artificial Intelligence, 
Robotics and Automation in Space (Tokyo 1997) 


164 


8.10 


8.11 


8.12 


8.13 


8.14 


第 1 篇。 机 器 人 学 基础 





R. A. Brooks: The Behavior Language: User's Guide, 
Technical Report AIM-1227, MIT Artificial Intelligence 
Lab (1990) 

R.J. Firby, M.G. Slack: Task execution: Interfacing to 
reactive skill networks, Working Notes: AAAI Spring 
Symposium on Lessons Learned from Implemented 
Architecture for Physical Agents (Stanford 1995) 

E. Gat: ESL: A Language for Supporting Robust Plan 
Execution in Embedded Autonomous Agents, Proc. 
of the IEEE Aerospace Conference (1997) 

V. Verma, T. Estlin, A. Jónsson, C. Pasareanu, R. Sim- 
mons, K. Tso: Plan Execution Interchange Language 
(PLEXIL) for Executable Plans and Command Se- 
quences, Proc. 8th International Symposium on 
Artificial Intelligence, Robotics and Automation in 
Space (Munich 2005) 

S.A. Schneider, V.W. Chen, G. Pardo-Castellote, 
H.H. Wang: ContralShell: A Software Architecture for 
Complex Electromechanical Systems, Int. J. Robot. 
Res. 17(4), 360-380 (1998) 

National Instruments: LabVIEW (National Instru- 
ments, Austin 2007), http://www.ni.com/labview/ 
N.J. Nilsson: A Mobile Automaton: An Application 
of Al Techniques, Proc. of the First International 
Joint Conference on Artificial Intelligence (Morgan 
Kaufmann Publishers, San Francisco 1969) pp. 509- 
520 

N.J. Nilsson: Principles of Artificial Intelligence 
(Tioga, Palo Alto 1980) 

P.E. Agre, D. Chapman: Pengi: An implementation 
of a theory of activity, Proc. of the Fifth National 
Conference on Artificial Intelligence (1987) 

R.C. Arkin: Behavior-Based Robotics (MIT Press, 
Cambridge 1998) 

J.H. Connell: SSS: A Hybrid Architecture Applied to 
Robot Navigation, Proc. IEEE International Confer- 
ence on Robotics and Automation (1992) pp.2719- 
2724 

M. Mataric: Integration of Representation into 
Goal-Driven Behavior-Based Robots, Proc. IEEE In- 
ternational Conference on Robotics and Automation 
(1992) 

l. Horswill: Polly: A Vision-Based Artificial Agent, 
Proc. of the National Conference on Artificial Intel- 
ligence (AAAI) (1993) 

D.W. Payton: An Architecture for Reflexive Auto- 
nomous Vehicle Control, Proc. IEEE International 
Conference on Robotics and Automation (1986) 

J.K. Rosenblatt: DAMN: A Distributed Architecture 
for Mobile Robot Navigation. Ph.D. Thesis (Carnegie 
Mellon Univ., Pittsburgh 1997) 

R.C. Arkin: Motor schema-based mobile robot nav- 
igation, Int. J. Robot. Res. 8(4), 92-112 (1989) 

M. Arbib: Schema Theory. In: Encyclopedia of Artifi- 
cial Intelligence, ed. by S. Shapiro (Wiley, New York 
1992) pp. 1427-1443 

0. Khatib: Real-time obstacle avoidance for ma- 
nipulators and mobile robots, Proc. of the IEEE 
International Conference on Robotics and Automa- 
tion (1985) pp. 500-505 

R.C. Arkin: Integrating behavioral, perceptual, and 
world knowledge in reactive navigation, Robot. 
Autonom. Syst. 6, 105-122 (1990) 

R.C. Arkin, T. Balch: AURA: Principles and practice 


8.33 


8.39 


8.40 


8.41 


8.42 


8.43 


8.44 


8.45 


8.46 


8.47 


8.48 








in review, J. Exp. Theor. Artif. Intell. 9(2/3), 175-188 
(1997) 

R.J. Firby: Adaptive Execution in Complex Dynamic 
Worlds. Ph.D. Thesis (Yale Univ., New Haven 1989) 
R.J. Firby: Task Networks for Controlling Continuous 
Processes, Proc. of the Second International Confer- 
ence on Al Planning Systems (1994) 

R.P. Bonasso: Integrating Reaction Plans and layered 
competences through synchronous control, Proc. 
International Joint Conferences on Artificial Intel- 
ligence (1991) 

S.J. Rosenschein, L.P. Kaelbling: The synthesis of 
digital machines with provable epistemic proper- 
ties, Proc. of the Conference on Theoretical Aspects 
of Reasoning About Knowledge (1998) 

L.P. Kaelbling: Goals as parallel program specifi- 
cations, Proc. of the Sixth National Conference on 
Artificial Intelligence (1988) 

L. P. Kaelbling: Compiling Operator Descriptions into 
Reactive Strategies Using Goal Regression, Technical 
Report, Teleos Research, TR90-10, (1990) 

R.P. Bonasso, R.J. Firby, E. Gat, D. Kortenkamp, 
D.P. Miller, M.G. Slack: Experiences with an archi- 
tecture for intelligent, reactive agents, J. Exp. Theor. 
Artif. Intell. 9(2/3), 237-256 (1997) 

E. Gat: Integrating Planning and reacting in a 
heterogeneous asynchronous architecture for con- 
trolling real-world mobile robots, Proc. of the 
National Conference on Artificial Intelligence (AAAI) 
(1992) 

G.N. Saridis: Architectures for Intelligent Controls. In: 
Intelligent Control Systems: Theory and Applications, 
ed. by Gupta, Sinhm (IEEE Press, Piscataway 1995) 
R. Alami, R. Chatila, S. Fleury, M. Ghallab, F. In- 
grand: An architecture for autonomy, Int. J. Robot. 
Res. 17(4), 315-337 (1998) 

M. Ghallab, H. Laruelle: Representation and control 
in IxTeT, a temporal planner, Proc. of AIPS-94 (1994) 
P. Laborie, M. Ghallab: Planning with sharable re- 
source constraints, Proc. of the International Joint 
Conference on Artificial Intelligence (1995) 

M.P. Georgeff, F.F. Ingrand: Decision-Making in 
an Embedded Reasoning System, Proc. of Inter- 
national Joint Conference on Artificial Intelligence 
(1989) pp. 972-978 

F. Ingrand, R. Chatila, R. Alami, F. Robert: PRS: 
A high level supervision and control language for 
autonomous mobile robots, Proc. of the IEEE in- 
ternational Conference On Robotics and Automation 
(1996) 

N.P. Muscettola, P. Nayak, B. Pell, B.C. Williams: Re- 
mote agent: To boldly go where no Al system has 
gone before, Artif. Intell. 103(1), 5—47 (1998) 

B.C. Williams, P.P. Nayak: A Model-based Approach 
to Reactive Self-Configuring Systems, Proc. of AAAI 
(1996) 

J.S. Albus: Outline for a theory of intelligence, IEEE 
Trans. Syst. Man Cybernet. 21(3), 473-509 (1991) 

B. Sellner, F.W. Heger, L.M. Hiatt, R. Simmons, 
S. Singh: Coordinated Multi-Agent Teams and Slid- 
ing Autonomy for Large-Scale Assembly, Proc IEEE 
94(7), 1425-1444 (2006), special issue on multi-agent 
systems 

D. Goldberg, V. Ciciretlo, M.B. Dias, R. Simmons, 


8.49 


8.51 


8.53 


8.55 


8.57 


8.60 


8.61 


第 8 章 ”机 器 人 体系 结构 与 程序 设计 


S. smith, A. Stentz: Market-Based Multi-Robot Plan- 
ning in a Distributed Layered Architecture. In: 
Multi-Robot Systems: From Swarms to Intelligent 


Automata, Vol.ll, ed. by A. Schultz, L. Parker, 
F.E. Schneider (Kluwer, Dordrecht 2003) 
J.S. Albus, R. Lumia, H.G. McCain: NASA/NBS 


Standard Reference model for Telerobot Control 
System Architecture (NASREM), National Bureau of 
Standards, Tech Note #1235, NASA $S-GFSC-0027 
(1986) 

D.R. Blidberg, S.G. Chappell: Guidance and control 
architecture for the EAVE vehicle, IEEE J. Ocean Eng. 
11(4), 449-461 (1986) 

R. Volpe, I. Nesnas, T. Estlin, D. Mutz, R. Petras, 
H. Das: The CLARAty architecture for robotic auton- 
omy, Proc. of the IEEE Aerospace Conference (Big Sky 
2001) 

ILA. Nesnas, R. Simmons, D. Gaines, C. Kunz, 
A. Diaz-Calderon, T. Estlin, R. Madison, J. Guineau, 
M. McHenry, |. Shu, D. Apfelbaum: CLARAty: Chal- 
lenges and steps toward reusable robotic software, 
Int. J. Adv. Robot. Syst. 3(1), 023-030 (2006) 

T. Estlin, D. Gaines, C. Chouinard, F. Fisher, R. Cas- 
taño, M. Judd, R. Anderson, |. Nesnas: Enabling 
Autonomous Rover Science Through Dynamic Plan- 
ning and Scheduling, Proc. of IEEE Aerospace 
Conference (Big Sky 2005) 

R. Knight, G. Rabideau, S. Chien, B. Engelhardt, 
R. Sherwood: CASPER: Space Exploration through 
Continuous Planning, IEEE Intell. Syst. 16(5), 70-75 
(2001) 

R. Simmons, D. Apfelbaum: A Task Description Lan- 
guage for Robot Control, Proc. of Conference on 
intelligent Robotics and Systems (Vancouver 1998) 
T.A. Estlin, D. Gaines, C. Chouinard, R. Castano, 
B. Bornstein, M. Judd, 1.A.D. Nesnas, R. Anderson: 
increased Mars Rover Autonomy using AI Planning, 
Scheduling and Execution, Proc. of the International 
Conference On Robotics and Automation (2007) 
pp. 4911-4918 

D. Musliner, E. Durfee, K. Shin: World modeling for 
dynamic construction of real-time control plans, 
Artif. Intell. 74(1), 83-127 (1995) 

D.J. Musliner, R.P. Goldman, M.J. Pelican: Using 
Model Checking to Guarantee Safety in Automatically- 
Synthesized Real-Time Controllers, Proc. of Inter- 
national Conference on Robotics and Automation 
(2000) 

B. Espiau, K. Kapellos, M. Jourdan: Formal Verifica- 
tion in Robotics: Why and How?, Proc. International 
Symposium on Robotics Research (Herrsching 1995) 
G. Berry, G. Gonthier: The Esterel synchronous 
programming language: Design, semantics, imple- 
mentation, Sci. Comput. Program. 19(2), 87-152 
(1992) 

M. Jourdan, F. Maraninchi, A. Olivero: Verifying 
quantitative real-time properties of synchronous 
programs, Proc. 5th International Conference on 
Computer-aided Verification (Springer, Elounda 
1993), LNCS 697 

G. Pardo-Castellote, S.A. Schneider: The Network 
Data Delivery Service: Real-Time Data Connectivity 
for Distributed Control Applications, Proc. of Inter- 
national Conference on Robotics and Automation 


8.65 


8.66 


8.75 


8.81 


8.82 


165 


(1994) pp. 2870-2876 

JAUS Reference Architecture Specification, Volume Il, 
Part 1 Version 3.2 (available at 

http: //www.jauswg.org/baseline/refarch. html) 
JAUS Tutorial Powerpoint slides (available at: 
http://www.jauswg.org/) 

JAUS Domain Model Volume I, Version 3.2 (available 
at http://www.jauswg.org/baseline/ 
current_baseline.shtm}) 

E. Gat: ALFA: A Language for Programming Reac- 
tive Robotic Control Systems, Proc. IEEE International 
Conference on Robotics and Automation (1991) 
pp. 116-1121 

R.A. Brooks: Elephants don’t play chess, J. Robot. 
Autonom. Syst. 6, 3-15 (1990) 

L.P. Kaelbling: Rex- A symbolic language for the 
design and parallel implementation of embed- 
ded systems, Proc. of the 6th AIAA Computers in 
Aerospace Conference (Wakefield 1987) 

E. Gat: Non-Linear Sequencing and Cognizant Fail- 
ure, Proc. AIP Conference (1999) 

E. Gat: On the role of stored internal state in the 
control of autonomous mobile robots, Al Mag. 14(1), 
64-73 (1993) 

J.L. Peterson: Petri Net Theory and the Modeling of 
Systems (Prentice Hall, Upper Saddle River 1981) 

K. Currie, A. Tate: O-Plan: The open planning archi- 
tecture, Artif. Intell. 52(1), 49-86 (1991) 

D.S. Nau, Y. Cao, A. Lotem, H. Mufioz—Avila: SHOP: 
Simple hierarchical ordered planner, Proc. of the In- 
ternational Joint Conference on Artificial Intelligence 
(1999) pp. 968-973 

S. Chien, R. Knight, A. Stechert, R. Sherwood, 
G. Rabideau: Using iterative repair to improve the 
responsiveness of planning and scheduling, Proc. 
of the International Conference on Al Planning and 
Scheduling (2000) pp. 300-307 

N. Muscettola: HSTS: Integrating planning and 
scheduling. In: Intelligent Scheduling, ed. by M. Fox, 
M. Zweben (Morgan Kaufmann, San Francisco 
1994) 

R. Simmons, J. Fernandez, R. Goodwin, S. Koenig, 
J. O'Sullivan: Lessons Learned From Xavier, IEEE 
Robot. Autom. Mag. 7(2), 33-39 (2000) 

R. Simmons: Inter Process Communication (Carnegie 
Mellon Univ., Pittsburgh 2007), www.cs.cmu.edu/ 
IPC 

S.W. Ambler: UML 2 Sequence Diagramms (Ambisoft, 
Toronto 2007), www.agilemodeling.com/artifacts/ 
sequenceDiagram.htm 

D. Kortenkamp, R.P. Bonasso, R. Murphy: Artificial 
intelligence and Mobile Robots (AAAI Press/The MIT 
Press, Cambridge 1998) 

R. Murphy: {ntroduction to Al Robotics (MIT Press, 
Cambridge 2000) 

R. Siegwart, 1.R. Nourbakhsh: Introduction to Auto- 
nomous Mobile Robots (MIT Press, Cambridge 2004) 
R. Simmons, D. Goldberg, A. Goode, M. Montemerlo, 
N. Roy, B. Sellner, C. Urmson, A. Schultz, M. Abram- 
son, W. Adams, A. Atrash, M. Bugajska, M. Coblenz, 
M. MacMahon, D. Perzanowski, |. Horswill, R. Zubek, 
D. Kortenkamp, B. Wolfe, T. Milam, B. Maxwell: 
GRACE: An autonomous robot for the AAAI Robot 
Challenge, AAAI Mag. 24(2), 51-72 (2003) 


166 


8.83 


第 1 篇 ”机 器 人 学 基础 


R. Gockley, R. Simmons, J. Wang, D. Busquets, C. DiS- 
alvo, K. Caffrey, S. Rosenthal, J. Mink, S. Thomas, 
W. Adams, T. Lauducci, M. Bugajska, D. Perzanowski, 
A. Schultz: Grace and George: Social Robots at AAAI, 
AAAI 2004 Mobile Robot Competition Workshop (AAAI 
Press, 2004), Technical Report WS~04-11, pp. 15- 


8.84 


20 
M.P. Michalowski, S. sabanovic, C. DiSalvo, D. Bus- 
quets, L.M. Hiatt, N.A. Melchior, R. Simmons. 


Socially: Distributed Perception: GRACE plays social 
tag at AAAI 2005, Auton. Robot. 22(4), 385-397 (2007) 


第 9 ae 


PUAT A E fe HERE J iA 


Joachim Hertzberg, Raja Chatila 


wk ih 


人 工 智能 (AI) 推理 技术 涉及 推理 、 规 划 和 
学 习 ， 已 有 大 量 成 功 应 用 的 记录 。 那 么 ， 它 能 作为 
自主 移动 机 器 人 的 方法 工具 箱 吗 ? 未 必 ! 因为 移动 
机 器 人 关于 动态 的 、 部 分 可 知 的 环境 的 推理 与 基于 
知识 的 纯 软 件 系统 (其 中 多 数 著名 成 果 已 记录 在 
R) 中 的 推理 可 能 有 着 本 质 的 不 同 。 

本 章 主要 探讨 基于 符号 的 人 工 智 能 推理 中 与 机 
器 人 有 关 的 内 容 。 先 一 般 性 介绍 知识 表示 与 推理 的 
基本 方法 ， 包 括 基于 逻辑 的 方法 和 基于 概率 的 方 
法 。 然 后 专门 探讨 与 机 器 人 有 关 的 一 些 特殊 问题 ， 
包括 基于 逻辑 的 高 级 机 器 人 控制 、 模 糊 逻 辑 以 及 时 
间 约 束 推理 的 问题 。 最 后 ， 详细 介绍 推理 的 两 种 一 
般 性 应 用 一 一 动作 规划 和 学 习 。 

一 般 性 的 推理 目前 还 不 是 自主 移动 机 器 人 了 配备 
的 标准 功能 。 本 章 除 了 介绍 与 机 器 人 有 关 的 人 工 智 
能 推理 的 研究 现状 外 ， 还 会 指出 为 实现 机 器 人 智能 
推理 而 有 待 进一步 研究 解决 的 问题 。 

本 章 首先 在 9.1 节 总 体 上 回顾 -下 知识 表示 和 
演绎 推理 ， 然 后 在 9. 2 节 较 为 详细 地 探讨 专门 考虑 
机 器 人 相关 应 用 的 推理 问题 。 介 绍 完 推理 的 方法 后 ， 
再 介绍 推理 的 一 般 性 应 用 ， 即 9. 3 节 的 动作 规划 和 


尽管 关于 移动 机 器 人 中 使 用 符号 推理 的 必要 性 
和 明智 性 有 过 争论 , 但 目前 在 机 髓 人 的 控制 系统 的 
某 个 部 分 或 某 层 中 应 该 或 者 可 以 包含 推理 这 一 点 上 
似乎 达成 了 共识 。 将 推理 功能 融 人 控制 器 的 其 他 部 
分 并 保证 控制 周期 时 间 足 够 短 ( 以 使 机 器 人 能 在 动 
态 环境 中 安全 地 行动 ) 是 个 难题 ,混合 控制 体系 结 
H (参见 第 8 章 ) 将 成 为 解决 这 个 难题 的 典型 软件 
结构 。 

符号 推理 在 这 里 是 按照 经 典 人 工 智 能 (AI) 中 
的 含义 来 理解 的 ， 即 基于 符号 的 慎 思 ， 如 一 阶 谓词 多 
辑 (FOPL) 或 中 叶 斯 概率 理论 ， 但 其 中 通常 有 些 限 
制 或 扩展 ， 并 需要 在 表达 能 力 与 推理 速度 之 间 进 行 权 
衡 ， 以 求 二 者 的 最 佳 组 合 。 


O 译 者 注 ， 即 符号 与 真实 对 象 之 间 的 对 应 关系 问题 。 


刘海 波 诺 


9. 4 节 的 机 带 学 习 ， 9.5 节 进 行 总 结 。 
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9.1 知识 表示 与 推理 


推理 时 要 求 推理 器 〈 这 里 就 是 指 机 器 人 ) 对 要 
推理 的 环境 的 某 些 部 分 (或 某 些 方面 ) 有 一 个 明确 
的 表示 ， 这 就 立即 引出 两 个 问题 : 什么 样 的 格式 适用 
于 这 种 明确 的 表示 ? 要 表示 的 知识 来 自 哪 里 ? 

第 二 个 问题 是 指 基 于 先前 的 符号 描述 和 从 传感器 
或 与 其 他 Agent 通信 获取 的 环境 信息 对 机 器 人 的 环境 
(至 少 是 环境 的 一 部 分 ) 实时 地 生成 并 维护 一 种 符号 
描述 的 问题 。 总 的 来 说 ， 这 个 问题 迄今 尚未 解决 。 它 
涉及 人 工 智能 的 基础 理论 ， 如 符号 接地 ”" 和 对 象 锚 
定 4 问 题 人 ,因此 ， 机 器 人 中 实际 的 符号 推理 仅 限 
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于 能 被 保持 到 最 近 的 那 部 分 知识 。 显 然 ， 这 包括 关 
于 环境 的 静态 知识 〈 如 建筑 物 中 的 拓扑 环境 及 其 相 
互 关 系 ) 、 符 号 表 中 可 用 的 临时 知识 〈 如 设备 管理 
数据 库 中 的 知识 ) 以 及 最 富 挑战 性 的 从 传感器 数据 
中 提取 的 符号 数据 。 通 过 摄像 机 数据 进行 目标 识别 
(参见 第 23 章 ) 就 是 一 个 与 这 里 探讨 的 问题 有 关 的 
方法 。 

本 节 探 讨 第 一 个 问题 的 答案 ， 即 适用 于 知识 表示 
的 形式 化 问题 。 这 里 的 适用 性 必须 同时 考虑 到 两 个 方 
面 《 恰 如 硬币 的 两 个 面 ) : 一 方面 是 认 知 适用 性 一 - 
这 种 形式 能 将 环境 的 目标 侧面 简洁 准确 地 表达 出 来 
吗 ? 男 一 方面 是 计算 适用 性 一 一 这 种 形式 能 将 典型 的 
推理 结果 切实 高 效 地 推导 出 来 吗 ? 二 者 之 间 需 要 权 
衡 。 很 丰富 、 很 有 表现 力 从 而 在 认识 论 上 很 有 吸引 力 
的 形式 ， 却 往往 伴随 着 难于 处 理 甚 至 逻辑 上 不 可 判定 
的 问题 ， 反 之 亦 然 。 于 是 ， 知 识 表示 (KR) 可 以 定 
位 为 “AI 的 一 个 研究 领域 ， 致 力 于 设计 表示 特定 领 
域 的 知识 ”” ”| 。 

本 节 着 力 探讨 两 类 形式 化 方法 ， 即 逻辑 和 概率 理 
论 及 各 自 的 推理 过 程 。 要 想 了 解 关于 KR 领域 的 介绍 
和 最近 的 研究 成 果 ， 我 们 推荐 读者 阅读 本 章 后 面 给 出 
的 一 般 性 AT 和 KR 文献 。 此 外 ， 还 有 个 知识 表示 国 
际会 议 
sentation (KR) ， 两 年 一 次 ， 


9.1.1 逻辑 


一 阶 谓词 逻辑 (FOPL) 是 AI 领域 中 知识 表示 形 
式 化 方法 的 原型 。 但 必须 得 说 明 ， 它 并 不 能 同时 满足 
前 已 述 及 的 可 认 知 性 和 可 计算 性 要 求 ， 在 很 多 情况 
下 ,其 至 两 个 都 不 能 满足 。 然 而 ， 它 是 从 概念 上 和 数 
学 上 理解 用 确定 知识 进行 表示 和 推理 的 形式 化 方法 的 
基础 。 

这 里 假定 读者 都 已 了 解 FOPL 的 基本 概念 ， 不 再 
次 述 ， 大 家 可 以 参阅 众多 的 Al 教材 和 介绍 。 每 一 部 
经 典 AI 教材 都 会 介绍 FOPL， 参 考 文献 [9.4, 5] 亦 
不 例外 。 参 考 文献 [9.6], [9.7] 和 [9.8] 分 别 介 
绍 了 逻辑 的 原理 、 应 用 和 数学 方法 。 

在 逻辑 系统 中 ， 对 知识 进行 形式 化 表示 便于 从 该 
知识 得 出 推论 〈 利 用 已 经 证 明 为 完备 可 靠 的 逻辑 演 
算 进行 推理 ) 。 自 动 演绎 是 逻辑 和 AI 的 一 个 分 支 领 
域 ， 已 经 实现 了 大 量 很 有 力 的 演绎 系统 可 供 使 用 
(参见 参考 文献 [9.4] 第 9 章 的 介绍 ,参考 文献 
[9.9] 是 较 新 的 、 综 合 性 的 汇编 ) 。 

依靠 逻辑 推理 ， 机 器 人 能 推断 出 大 量 很 难 或 不 可 
能 获取 的 事实 。 例 如 ,假定 机 器 人 通过 获取 和 解 译 传 
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每 着 偶数 年 召开 。 


感 数据 ， 感 知 到 办 公 楼 中 的 Di 号 门 现在 是 关 着 的 ， 
在 有 些 专门 的 FOPL 语言 中 用 Closed( Do) 表示 ， 假 
定 是 符号 的 直觉 的 解 译 。 进 一 步 假设 机 器 人 关于 办 公 
楼 的 静态 知识 库 包 括 以 下 语句 : 

Connects ( Do ,Cs , Rw), 

Connects ( Dsog ,Cs Rog) , 

Connects ( D oga , Roog » Row ) ， 

Vd,l, ,ll Connects(d,l, sl, )+>+Connects( dl, ,1 ) 1, 

Vd. | Closed(d)<*— Open(d) }, 

VL. | At( L) —Accessible( 1) ] , 

Vl, ,ls. [ Accessible (1, )—( Ad. [ Connects (d, L, 
L,) ^ Open( d) |—+Accessible( 1, ) ) ] 

常量 D, 和 变量 d 表示 门 ，R, 表示 房间 ，C, 表示 
走廊 ， 变 量 1 ALL, 表示 位 置 ， 即 房间 和 走廊 。 假 定 机 
个 人 的 定位 系统 告诉 它 当 前 房间 或 走廊 的 位 置 就 用 
Ait). 

那么 ， 假 定 机 器 人 知道 它 自己 (C), WAA 
Closed( Ds) 意味 着 ~ Open( Dog), BARA, 1% 
当 Open( Dog) 人 Open(D ) 为 真 时 才 有 Accessible 
(Rsw ) ， 这 样 ， 比 如 执行 一 项 到 Row 房 间 的 投递 任务 ， 
机 知人 可 以 重 规划 经 过 Rsos 的 路 线 ， 除 非 已 知 Doos 和 
Dsog。 中 至 少 有 一 扇 是 关 着 的 ， 如 果 其 中 一 扇 或 两 肩 的 
状态 都 不 知道 (根据 当前 的 知识 库 ， 就 意味 着 既 不 
是 Open( + ) 也 不 是 Closed(. )。 那 么 ，Rw 的 可 达 
性 既 不 能 被 证 明 为 可 行 也 不 能 被 证 明 为 不 可 行 ， 于 是 
规划 通过 Dog 和 Dasos. 将 作为 可 选项 保留 ， 同 时 现场 收 
集 它 们 必要 的 状态 信息 。 

如 这 个 小 例子 所 示 ，FOPL 是 一 个 有 力 的 表示 与 
推理 工具 ， 而 且 ， 其 理论 也 易于 理解 。 不 过 ， 众 所 
周知 FOPL 中 的 结果 一 般 是 不 可 判定 的 ， 这 就 意味 
着 一 个 可 靠 的 、 完 备 的 演绎 算法 在 一 些 特定 推理 情 
帝 下 其 至 不 能 保证 终止 ,就 更 不 用 说 迅速 得 出 结 
EIo 

然而 ， 这 并 不 意味 着 逻辑 就 完全 不 能 作为 表示 
和 推理 的 工具 。 很 多 应 用 并 不 需要 FOPL 完全 的 表 
达 性 ， 此 外 ， 有 很 多 有 趣 的 FOPL 语言 子 集 是 可 判 
定 的 ， 并 在 很 多 实际 情况 中 可 由 算法 高 效 地 处 理 。 
于 是 ,为 了 更 广泛 的 应 用 ，KR 研究 人 员 一 直 在 努 
力 寻 找 FOPL 子 集 及 适用 的 推理 过 程 ， 可 以 胜任 可 
认 知 性 和 可 计算 性 需求 。 下 面 详细 探讨 其 中 的 命题 
逻辑 和 描述 人 逻辑 。 

1. 命题 系统 

在 相当 多 的 实际 情况 中 ，FOPL 理论 (公式 集 ) 
实际 表示 有 限 域 。 从 逻辑 上 讲 ， 它 们 具有 有 限 的 海 伯 
伦 域 ， 或 至 少 能 改写 成 具有 有 限 海 伯 伦 域 的 形式 。 在 
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这 种 情况 下 ， 用 FOPL 语法 表示 域 理论 可 能 依然 是 最 
得 心 应 手 的 。 但 所 有 超越 纯 命 题 系统 的 表示 仪 仅 是 为 
了 符号 上 的 方便 。 例 如 ， 一 条 陈述 机 器 人 在 一 个 时 刻 
只 能 处 于 一 个 位 置 (房间 或 走廊 ) 的 公理 : 
Vo,b [AtCl, ) (> Ath)v L =4,)] 

对 于 有 限 的 建筑 物 ， 可 以 展开 为 一 种 元 长 但 却 等 价 的 
形式 ， 这 种 形式 可 以 明确 地 处 理 所 有 位 置 。 例 如 ， 在 
一 个 六 层 楼 中 ; 

At( Ro) > [> At (Ro) A 7 At (Rw) 和 
At( R54) A 7 Ail Ca) A 7 AlCu) Av A = ACC) J, 

At ( Rog, ) > Lo At ( Rog) A At (Rog) Av 3 
At( Reg A At( Cy, An Atl Cy, )AAn At Cs) |, 


其 中 ， 一 个 谓词 (如 上 面 的 4) 的 每 一 个 自由 变 元 
都 取 值 后 ， 字 面 上 即 被 看 作 命 题 变 量 。 

这 里 有 个 好 消息 ，FOPL 理论 在 有 限 海 伯 伦 域 
上 对 应 的 展开 理论 是 命题 性 的 ， 因 此 是 可 判定 的 ， 
而 且 ， 在 一 些 实际 条 件 下 ， 如 FOPL 中 的 变 元 是 很 
清楚 的 〈 即 如 涉及 房间 和 走廊 的 变 元 上 和 疡 的 信 
息 可 用 )， 则 可 以 用 更 精简 的 FOPL 语法 机 械 地 
生成 。 

潜在 的 坏 消息 是 ， 现 在 的 命题 系统 可 以 由 大 量 命 
题 语句 构成 ， 一 般 情况 下 ， 需 要 生成 所 有 FOPL 语句 
中 的 变 元 置换 的 所 有 组 合 ， 这 会 导致 计算 复杂 度 随 者 
FOPL 变 元 的 域 的 尺寸 旺 指数 级 增长 。 

不 过 ,命题 可 满足 性 检查 或 模型 检查 技术 正在 
突飞猛进 ， 能 使 有 成 千 上 万 个 变 元 要 处 理 的 命题 系 
统 在 常规 硬件 上 以 秒 级 的 计算 时 间 进 行 处 理 。 当 和 存 
在 可 满足 性 命题 公式 模型 或 很 多 事实 的 真 假 性 已 知 
时 《如 通过 独立 定位 已 知 机 器 人 4i(C;))， 这 些 方 
法 会 特别 有 效 ， 而 这 两 种 都 是 实际 知识 表示 中 常见 
的 情况 。 

参考 文献 [9.4] 第 7 章 介 绍 了 模型 检查 。 有 一 
类 算法 都 是 基于 经 典 的 Davis-Putnam ( DPLL ) = 
yp lO 10) ， 它 试图 系统 地 构建 一 个 给 定理 论 的 命题 模 
型 ， 有 效 地 传播 变 元 的 解释 约束 。 男 一 类 算法 应 用 局 
部 搜索 技术 ， 试 图 使 用 随机 (Monte Carlo) 变 元 指派 
生成 解释 。 参 考 文献 [9.11] 收录 了 近来 的 论文 并 
总 结 了 研究 现状 ， 其 中 有 一 篇 介绍 SAT2002 竞赛 结 
果 的 论文 ， 详 细 讨论 了 最 近 可 满足 性 检查 器 关于 综合 
问题 ( 非 同一 般 的 难 ) 的 性 能 。 

2. 描述 逻辑 

20 世纪 70 年 代 出 现 了 描述 逻辑 (DL) ， 这 是 Al 
领域 知识 表示 中 的 一 种 严格 的 形式 化 方法 ， 它 包括 语 








义 网 络 和 框架 系统 。 从 逻辑 上 讲 ，DL 有 很 多 变种 ， 
形成 一 类 FOPL 的 可 判定 子 集 。 

使 用 DL 语言 表示 某 特 定 领域 的 知识 需要 两 个 部 
分 。 首 先 ， 领 域 的 顶层 本 体 要 形式 化 ， 它 引 和 一般 性 
的 领域 概念 及 概念 间 的 关系 。 所 有 本 体 中 有 一 个 特别 
有 趣 的 关系 类 型 是 超 类 - 子 类 关系 。DL ( 某 种 意义 上 
是 强制 可 判定 性 ) 严格 禁止 在 概念 间 设 定 循环 关系 。 
超 类 关系 隐 含 着 概念 上 的 层次 关系 ， 可 以 定义 属性 继 
承 ， 很 多 地 方 类 似 于 面向 对 象 程序 设计 。 由 于 历史 原 
央 ， 基 于 描述 化 辑 的 领域 知识 表示 中 ， 这 第 一 部 分 常 
被 称 作 TBox (或 术语 知 识 )。 

DL 语言 中 的 概念 与 一 元 谓词 相关 。 举 个 例子 ， 一 
个 机 器 人 导航 领域 的 本 体 可 以 包括 Door, Location 等 
概念 ， 概 念 的 层次 是 通过 定义 概念 相等 ( = ) RF 
概念 属性 (如 ，Room CC Location 和 Corridor C Location ) 
来 建立 的 。 概 念 可 以 用 概念 合 取 、 析 取 和 否定 (分 
别 用 mm 、U 和 =” RR) 组 合 而 成 ， 如 ， 可 以 将 概念 
如 此 定义 ，Focation = Room U Corridor, Door = Closed U 
Open 和 Open =~ Closed, 

DL 语言 中 的 任务 与 二 元 谓词 对 应 ， 如 引 向 
(leadsTo) 门 和 某 个 位 置 。 任 务 的 逆 、 交 和 并 可 以 如 
预期 的 一 样 定义 ， 如 leadsTo = leadsFrom ”就 是 定义 
道 任务 的 一 例 。 任 务 可 以 复合 ， 如 定义 adjacent = 
leadsFromo leadsTo (位 置 1 邻接 mm 当日 仅 当 通过 某 个 
门 能 从 ! 到 m)。 最 后 ， 概 念 与 任务 可 以 组 合 起 来 定 
义 新 的 概念 和 任务 。 特 别 地 ， 也 可 以 用 量词 限定 任务 
填充 算 子 ， 即 ， 可 以 用 个 体 对 象 (参见 后 面 的 内 容 ) 
连续 替换 任务 参数 ， 例 如 ， 可 以 定义 BlockedLoc = 
Location J leadsFrom. Open (BÆ T A-T E AWA 
定 规则 ) 。 不 同 的 DL 变种 中 ， 其 他 可 用 的 算 子 有 所 
不 同 ， 详 见 参考 文献 [9.3]. 

作为 用 DL 表示 领域 知识 的 第 二 部 分 ， 需 要 给 概 
念 和 任务 引入 个 体 对 象 ， 领 域 知识 表示 的 这 一 部 分 称 
fe ABox 或 断 育 知识 ， 如 ， 可 以 断言 Room ( Rsw )、 
leadsTo( Daw, Rsw) 和 Closed ( Dogg ) o 

DL 提供 大 量 推理 服务 ， 都 是 基于 已 知 的 TBox 和 
ABox 中 的 逻辑 推理 ， 它 们 包含 概念 定义 的 一 致 性 、 
概念 的 包容 与 分 离 、ABox 关于 TBox 的 一 致 性 以 及 概 
念 与 任务 实例 ， 在 DL 中 所 有 这 些 都 是 可 判定 的 。 例 
如 ， 给 定 了 TBox 和 ABox 的 上 述 基本 内 容 ， 就 可 以 推 
断 出 每 一 项 都 是 一 致 的 ; BA BlockedLoc ( Rso ) (请 
注意 ， 这 里 只 有 Dyw 号 门 能 通 向 房间 Ryo) 。 这 些 DL 
推理 在 理论 上 很 难处 理 ， 但 在 很 多 实际 情况 中 运行 效 
率 还 是 很 高 的 。 

参考 文献 [9.3] SMART DL 研究 现状 。 
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2004 年 ，WWW 联盟 (W3C) 定义 了 Web 本 体 语言 
(OWL)“”， 作 为 语义 网 络 的 技术 基础 。 该 语言 
有 一 部 分 是 OWL-DL， 从 某 种 意义 上 就 是 前 已 述 及 的 
经 典 的 DL, OWL- DL 本 体 已 经 可 以 通过 Web 公开 使 
用 ， 参 见 参考 文献 [9.13] 中 的 人 门 介 绍 。 


9.1.2 概率 理论 


无 论 什 么 时 候 要 表示 实际 知识 ， 基 于 逻辑 的 KR 
形式 化 方法 都 是 值得 考虑 的 ， 由 此 可 以 进行 演绎 推 
理 。 但 机 器 人 要 用 到 的 关于 环境 的 部 分 知识 ， 并 不 真 
正 具备 这 一 特点 。 选 择 一 种 KR 形式 化 方法 〈 就 如 同 
选择 一 种 程序 设计 语言 ) ， 从 某 种 程度 上 是 一 种 党 
试 、 经 验 、 熟 悉 度 或 集成 考虑 。KR 术语 中 ， 某 些 领 
域 形式 化 方法 的 认 知 适用 性 已 经 不 再 是 可 以 精确 判定 
的 问题 。 

然而 ， 人 逻辑 (至少 其 经 典 变 种 ) 不 能 满足 某 些 
应 用 类 型 的 知识 表示 需求 。 处 理 不 确定 性 问题 便 是 
其 一 ， 甚 至 可 以 说 是 全 部 ， 因 为 不 确定 性 本 质 上 就 
是 个 超载 的 概念 。 知 识 不 足 是 其 一 个 方面 ， 这 种 情 
次 逻辑 方法 可 以 处 理 ， 因 为 一 些 事实 的 真 假 值 可 以 
保持 在 未 确定 状态 。 但 若 知 识 库 中 如 有 太 多 的 未 确 
定 知 识 ， 逻 辑 方 法 便 无 法 进行 令 人 感 兴 趣 的 演绎 推 
理 ， 因 为 这 时 候 在 逻辑 上 一 切 丝 有 可 能 。 不 过 ， 直 
党 上 不 同 的 可 能 结果 在 “可 能 性 ”上 会 有 显著 
区 别 。 

KR 领域 中 采用 贝 叶 斯 概率 作为 表示 和 推理 此 类 
不 确定 性 问题 的 手段 ， 它 利用 的 是 事实 间 的 相关 性 
而 不 是 严格 理 含 。 需 要 注意 的 是 ， 这 种 方法 融合 了 
缺少 精确 的 、 完 备 的 知识 的 各 种 来 源 。 有 些 知识 是 
AA, 要么 从 原理 上 就 是 不 可 知 的 ， 要么 就 是 建 
立 精 确 理论 或 确定 进行 可 靠 演绎 推理 相关 的 全 部 信 
息 的 代价 太 高 。 无 论 哪 种 情况 ， 用 概率 (而 不 是 用 
二 值 真 值 ) 都 可 以 求 得 近似 结果 。 需 要 注意 的 是 ， 
这 里 真 值 的 概念 与 经 典 逻辑 中 的 是 相同 的 ， 客 观 地 ， 
一 个 事实 被 假定 要 么 为 真 ， 要 么 为 假 ， 概 率 就 是 对 
相信 事实 为 真 的 主观 程度 进行 建 模 。 需 要 注意 的 
是 ， 这 与 模糊 逻辑 不 同 ， 后 面 会 简要 讲解 (参见 
9.2.2 47). 

与 9.1.1 节 类 似 ， 这 里 假定 对 概率 论 的 基本 
概念 都 熟悉 。 参 考 文献 [9.4] 中 的 第 13 章 有 很 
好 的 基础 性 介绍 。 想 再 深入 了 解 ， 还 有 大 量 的 各 
种 导论 教材 。 参 考 文献 [9. 14] 是 其 中 较 新 出 版 
的 一 部 。 

册 叶 斯 概率 理论 中 的 推理 其 要 义 是 : 已 知 其 
他 先 验 概 率 及 所 依赖 的 相关 概率 ， 来 推断 一 些 感 
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兴趣 事件 的 概率 。 实 际 上 ， 有 一 种 重要 的 概率 推 
理 叫 诊断 推理 ， 即 ， 已 知 因果 规则 (指定 从 因 到 
果 的 条 件 概率 ) ， 从 观察 到 的 结果 倒 推 回 隐 含 在 背 
后 的 原因 。 于 是 ， 对 于 潜在 的 原因 C 和 观察 到 的 结 
RE, (URI A: 已 知 先 验 概率 PCC) MPE), 
确定 后 验 概率 P(C | E)。 解 当然 是 由 贝 叶 斯 规则 给 
出 如 下 ， 
P(E | C)P(C) 

P(E) 

然而 ， 和 逻辑 推理 一 样 ， 这 个 理论 上 很 有 吸引 力 
的 原理 已 经 被 证 明 : 如 果 只 是 朴素 地 应 用 则 是 不 实用 
的 。 考 虑 到 可 能 不 只 有 1 个 结果 被 观察 到 ， 而 是 n 
个 ， 而 且 并 不 都 是 条 件 独立 的 。 用 贝 叶 斯 规则 的 一 般 
形式 ， 计 算 正 确 的 后 验 概率 是 很 简单 的 ， 但 谁 能 指定 
所 涉及 的 所 有 概率 呢 ? 最 坏 情况 是 0(2") ， 其 中 在 
实际 中 轻而易举 就 会 达到 几 百 。 

直到 20 世纪 80 年 代 末 期 ， 这 个 问题 才 或 多 或 少 
地 解决 了 。 一 种 方式 是 将 故意 看 成 是 独立 的 ， 然 
后 简单 地 用 个 独立 条 件 概率 PCE, | C) 近似 完全 的 
联合 概率 分 布 。 参 考 文献 [9.4] 第 14.7 节 对 此 及 其 
他 同类 方法 进行 了 综述 。 

贝 叶 斯 网 络 (BN) 从 其 问世 一直 沿用 至 今 。 
其 思想 是 在 有 向 循环 图 中 表示 出 随机 变量 ， 其 中 ， 当 
且 仅 当 一 个 节点 直接 条 件 依赖 于 对 应 的 父 节点 变量 
时 ， 该 节点 就 是 父 节点 集 的 直接 前 驱 。 于 是 ， 巨 大 的 
完全 概率 分 布 就 被 无 损 地 分 解 成 通常 很 小 的 局 部 联合 
概率 ， 其 诀窍 是 使 用 许多 已 知 的 变量 间 的 条 件 独立 来 
大 大 降低 表示 和 推理 的 难度 。 

图 9. 1 给 出 了 一 个 简单 的 贝 叶 斯 网 络 ， 表 示 D 由 
B 和 C 引 起 ， 由 条 件 概 率 表 给 出 的 概率 指定 局 部 的 联 
合 概率 分 布 。 此 外 ， 图 中 的 结构 表明 ， 知 道 了 五 和 C， 
就 独立 于 4 (知道 了 父 节 点 时 ， 该 节点 便 独 立 于 其 
祖先 ) HUET A, BWC, A, P(C|A, B) = 
P(C|A) 和 P(B|4,，C) =P(B |4)。 网 络 可 以 双向 
利用 : 自 底 向 上 ， 可 以 使 用 已 知 的 条 件 概率 去 解释 观 
察 到 的 现象 (诊断 ) ， 例 如 ， 如 果 观 察 到 DD， 可 以 推断 
出 更 有 可 能 的 原因 (BC); 自 顶 向 下 ， 可 以 传播 证 
据 来 计算 现象 出 现 的 概率 ， 如 , 已 知 4 (原因 ) 计算 
D 的 概率 。 

对 于 随 着 时 间 演 化 的 系统 ， 使 用 贝 叶 斯 网 络 的 
不 变 结 构 以 便 使 用 相同 的 推理 过 程 更 新 变量 值 这 一 
点 很 重要 。 这 样 的 网 络 称 为 动态 贝 叶 斯 网 络 
(DBN)。 图 9.2 给 出 了 一 个 这 样 的 网 络 ， 从 时 刻 7 
到 时 刻 T+1。 


P(C | E) = 
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PA PCAC AY 
ur | P( BIA) | REA A (OQA | P(CTA)[P(7CIA) 
P(BIAA)|P(ABIAA) rh POCI ~A) 


图 9.1 附带 条 件 概率 表 的 简单 贝 叶 斯 网 络 结构 
(D 的 条 件 概率 表 依赖 于 3 和 C， 此 处 省 略 。) 
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9.2 ”两 个 相继 时 间 步 的 动态 贝 叶 斯 
网 络 实例 (其 结构 不 随时 间 改 变 ) 


在 9.3.3 节 中 ， 还 会 看 到 专门 用 于 不 确定 性 规划 
的 概率 技术 ， 如 马尔 可 夫 决 策 过 程 。 


9.2 机 器 人 的 知识 表示 问题 


本 音 余 下 内 容 中 的 推理 方法 与 一 般 应 用 均 使 用 
(从 某 种 程度 上 讲 ) 逻辑 的 基本 形式 化 方法 的 变种 或 
员 叶 斯 概率 理论 。 两 种 形式 化 方法 (特别 是 当 包 含 
恋 种 时 ) 都 如 此 通用 和 有 力 ， 以 至 于 可 以 在 任何 KR 
应 用 中 有 所 贡献 。 

然而 ， 机 器 人 控制 系统 的 推理 与 其 他 基于 知识 的 
系统 中 的 推理 在 很 多 方面 都 有 所 不 同 。 基 于 知识 的 机 
器 人 是 一 个 嵌入 式 系统 ， 工 作 在 闭环 控制 中 ， 通 常 是 
在 资源 相当 有 限 的 动态 环境 中 ， 它 必须 解 译 自己 的 传 
感 器 输入 ， 至 少 要 自主 执行 一 部 分 判断 为 适当 的 动 
作 。 因 此 ， 基 于 知识 的 机 器 人 控制 有 特 珠 需要 ， 可 以 
说 ， 这 些 需要 在 离线 的 专家 系统 中 是 没有 的 ， 专 家 系 
统 通过 提示 专业 领域 中 有 经 验 的 人 来 输入 信息 ， 然 后 
将 输出 结果 写 人 到 文档 中 ， 给 更 有 经 验 的 人 去 分 析 ， 
如 果 他 们 感觉 正确 ， 还 可 能 去 执行 。 自 然 地 ， 这 种 区 
别 形 成 了 机 器 人 控制 对 KR 的 特殊 需要 ， 这 种 特殊 需 
要 可 能 许多 其 他 KR 用 户 都 不 感 兴趣 ， 处 于 主流 领域 
之 外 。 本 节 简 要 地 探讨 三 个 问题 。 

正式 开始 之 前 ， 先 说 几 句 知识 表示 在 设计 智能 机 
器 人 或 智 不 机 器 人 时 的 作用 问题 。 已 有 确 滞 的 证 据 表 
明 ， 一 些 无 需 表示 的 智能 形式 “已 在 机 器 人 中 得 以 


实现 。 本 书 第 38 章 会 介绍 一 些 这 方面 的 背景 知识 。 
显然 ， 如 果 根 据 符号 进行 的 推理 不 能 以 真实 传 感 数据 
和 执行 器 控制 为 基础 ， 那 最 复杂 的 表示 和 推理 系统 对 
机 器 人 也 毫 无 用 处 。 再 者 ， 表 示 与 推理 还 能 对 机 器 人 
性 能 改善 、 软 件 设计 和 用 户 接口 开发 大 有 神 益 ， 例 
如 ， 野 外 机 器 人 、 服 务 机 器 人 和 介入 机 器 人 等 应 用 
(Ui, PartF) 。 混 合 机 器 人 控制 系统 ( 见 第 8 章 ) 是 当 
前 常用 的 一 种 方式 ， 它 将 KR 技术 实例 与 机 器 人 中 的 
反应 控制 组 件 融 合 在 一 起 。 


9.2.1 高 级 机 器 人 控制 逻辑 


机 器 人 领域 本 质 上 是 动态 的 ， 包括 至 少 一 个 物理 
即 机 器 人 。 用 基于 逻辑 的 形式 化 方法 进行 表 
示 ， 会 产生 一 些 概念 上 和 技术 上 的 问题 ， 人 参考 文献 
[9.4] 的 第 10.3 节 对 此 进行 了 介绍 。 

很 简单 ， 这 些 来 自 于 动作 逻辑 模型 的 精确 表示 和 
高 效 推理 的 需要 。 从 逻辑 上 讲 ， 一 个 独立 动作 改变 有 
限 数量 事实 的 真 值 ， 而 保持 其 他 的 不 变 。 例 如 ， 在 某 
抽象 级 别 上 将 从 一 处 走 到 另 一 处 的 动作 建 模 成 原子 动 
作 ， 它 在 执行 前 后 会 改变 机 器 人 的 位 置 。 依 靠 模型 
化 ， 它 可 以 改变 电池 状态 和 里 程 数 ， 但 不 改变 建筑 物 
的 布局 和 总 统 的 和 名字。 用 时 辑 语言 精确 地 形式 化 动作 
以 使 事实 (应 用 动作 序列 后 可 能 改变 也 可 能 不 变 ) 
可 被 有 效 推理 的 问题 ， 已 经 形成 了 一 个 术语 ， 称 为 
“框架 问题 ”"。 文 献 中 已 对 此 多 有 关注 ， 也 有 大 量 实 
际 的 解决 方案 。 

另 一 个 问题 涉及 由 独立 变化 的 事实 做 出 的 必要 的 
基于 知识 的 更 新 。 例 如 ， 考 虑 一 个 机 器 人 坐 在 某 肩 门 
D 之 前 (由 自 定 位 系统 告知 其 位 置 ) 相信 门 D 是 开 
着 的 ,但 机 器 人 感知 到 的 是 一 扁 关 着 的 门 。 逻 辑 上 ， 
这 是 一 个 了 矛盾。 目前 从 理论 上 有 几 种 方法 可 以 使 知识 
与 感知 一 致 。 一 种 方法 是 假定 D 是 从 学 习 到 它 是 开 
着 的 之 后 关上 的 ， 这 可 能 是 最 直观 的 解释 。 逻 辑 上 ， 
栓 如 预期 的 一 样 ， 例 如 ,或 者 感知 失效 ,或 者 机 器 人 
是 被 时 空 挪移 到 本 就 关 着 的 门 前 。 在 这 些 解释 中 ， 有 
些 在 表面 上 看 起 来 更 合理 ， 有 些 在 还 辑 上 需要 取消 更 
少 的 基于 知识 的 公式 从 而 成 为 首选 。 理 想 状 态 下 ， 在 
用 新 信息 替换 旧 信 息 时 ， 必 须 确 认 已 经 取消 的 公式 的 
推论 不 再 可 信 。 

理论 上 ， 这 些 问 题 要 多 难 有 多 难 。 实 际 上 ， 它 们 
可 以 被 充分 限定 在 一 个 精确 的 逻辑 框架 内 求解 。 根 据 
情境 演算 的 经 典范 例 ?""] ， 典 型 的 求解 方案 会 在 公式 
中 采用 一 些 情境 或 保持 时 间 的 概念 ， 这 使 得 变化 可 以 
被 跟踪 。 典 型 的 求解 方案 也 会 放弃 推理 的 完备 性 ， 而 
采用 类 似 PROLOG 的 推理 引擎 。 这 样 的 解决 方案 在 
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CC 


机 器 人 控制 中 已 见报 道 的 应 用 有 三 个 案例 ， 即 
GOLOG” I8] 、 事件 演算 [9.19] 和 FLUX! 221 5 


9.2.2 模糊 逻辑 方法 


由 于 历史 原因 ， 处 理 经 典 AI 问题 的 大 量 方法 和 
技术 已 经 超出 了 AI 的 核心 范围 ， 这 些 方法 在 不 同 的 
领域 中 有 时 被 称 作 软 计算 ， 有 时 被 称 作 计算 智能 ， 其 
中 就 包括 模糊 逻辑 。 模 糊 逻 辑 显然 也 是 一 种 符号 推理 
方法 ， 而 且 ， 它 与 模糊 控制 有 着 共同 的 理论 基础 。 因 
为 模糊 控制 已 经 以 这 样 或 那样 的 方式 大 量 应 用 在 机 器 
人 控制 器 中 ， 所 以 模糊 逻辑 也 理所当然 地 成 为 机 器 人 
知识 表示 的 一 种 形式 化 方法 。 

首先 ， 模 糊 逻辑 的 本 体 论 基础 与 FOPL 和 概率 理 
论 的 有 所 不 同 ， 后 者 假定 谓词 客观 上 或 为 真 或 为 假 ， 
可 能 不 知道 其 真 值 ， 但 它 确 实 存在 。 模 糊 逻 辑 则 假定 
真 值 客观 上 以 某 种 程度 呈现 。 许 多 自然 语言 范畴 具有 
模糊 特点 ， 如 ， 说 某 人 “大 ”， 可 以 解释 为 在 某 些 极 
端 情况 下 客观 上 是 真 或 假 ， 但 如 何 客观 地 说 一 个 高 
185cm Æ 80kg 的 男人 算 不 算 大 呢 ? 

模糊 逻辑 被 看 成 是 命题 逻辑 (在 此 领域 中 常 被 
称 作 清 晰 逻辑 ) 的 推广 。 因 此 ， 模 糊 逻 辑 使 用 规范 
的 联络 词 A、V 、” 等 ， 但 要 将 其 真 值 函数 的 定义 从 
集合 10，1| 推广 到 [0, 1] 区 间 。 有 几 种 看 起 来 
挺 合理 的 推广 方法 ， 常 用 的 一 种 是 定义 : 

value( P) =1 - value( P) 

value( P V Q) = max {value( P) , value(Q) } 

其 他 联结 词 的 定义 可 以 如 法 炮制 ,已 有 大 量 不 同 
的 定义 和 付 诸 应 用 。 

模糊 演绎 推理 与 命题 演绎 推理 目的 典型 地 不 同 ， 
因此 推理 机 制 也 不 同 。 一 些 模糊 逻辑 理论 中 的 可 满足 
性 通常 已 经 不 再 是 人 们 感 兴趣 的 问题 ， 因 为 它 也 只 是 
在 某 种 程度 上 的 可 满足 ， 而 大 多 数 模糊 系统 通常 都 能 
至 少 有 点 儿 可 满足 性 。 模 糊 逻 辑 知识 库 通常 用 在 模糊 
推理 规则 集 上 的 前 向 链 推理 方式 中 ， 从 其 他 已 知 的 模 
糊 值 推断 出 模糊 变量 的 模糊 值 ， 这 就 是 模糊 知识 库 成 
功 应 用 于 机 器 人 控制 器 的 方式 ， 如 用 在 Saphira 控制 
结构 中 “” 。 举 例 来 说 ， 用 如 下 规则 确定 移动 机 器 人 
的 转 回 角 是 有 意义 的 : 


if ( freeRange right is_narrow) A (freeRange front is_ 


medium) ^ (freeRange left is_wide) 
then set angle medium_left 


其 中 ， 斜体 部 分 (right, is_narrow 等 ) 是 模糊 变量 。 


在 茶 特 定时 刻 ， 前 提 变 量 的 模糊 真 值 可 通过 定义 变量 
映 别 然后 读 取 距离 传感器 数据 来 确定 ， 如 将 is_medi- 
um 映射 到 均值 为 2m 的 正 态 分 布 上 ， 设 置 角 度 为 me- 
dium_left 可 以 映射 为 以 向 左 30° 为 均值 的 正 态 分 布 
上 上 上， 而 实际 设置 的 角度 最 终 将 通过 去 模糊 化 来 计算 ， 
即 ， 将 最 适用 的 规则 或 规则 集 的 模糊 变量 组 合 起 来 ， 
一 个 看 起 来 比较 合理 的 标量 值 可 能 是 结果 模糊 值 的 
重心 。 

尽管 在 软 计 算 与 核心 AI 之 间 存 在 着 世界 观 上 的 
争论 ， 但 模糊 推理 组 件 与 其 他 AI 组 件 还 是 能 很 好 地 
共处 于 一 个 机 器 人 控制 器 中 ,各 司 其 职 ，Saphira 体 
系 结构 便 是 一 例 。 


9.2.3 时 间 约 束 推 理 


与 很 多 一 般 的 AI 系统 不 同 ， 为 了 应 对 环境 的 动 
态 性 ， 机 器 人 必须 基于 传 感 数据 实时 进行 决策 ， 因 此 
它们 的 决策 应 该 在 有 限 的 时 间 内 生成 。 如 果 这 些 决 策 
需要 考虑 未 来 计划 ， 即 如 果 需 要 规划 ,问题 就 来 
了 一 一 实时 决策 实际 上 与 规划 的 无 界 性 并 不 兼容 
(规划 的 通用 形式 是 个 很 难处 理 的 问题 ) ， 再 加 上 基 
于 FOPL 推理 机 制 又 只 是 半 可 判定 的 。 

为 了 考虑 实时 约束 ， 人 们 提出 了 反应 规划 等 方 
法 “” ， 均 放弃 了 太 多 的 超前 规划 (一 次 只 规划 一 
步 )。 然 后 ， 时 间 约 东 的 解决 方案 通常 来 自 机 器 人 
系统 的 体系 结构 设计 (参见 第 8 章 ) ， 它 集成 决策 
层 和 反应 层 〈 可 以 在 有 限时 间 内 做 出 反应 )。 决 策 
层 常 包含 规划 器 和 监控 系统 ， 用 预定 义 的 过 程 或 肢 
本 确保 任务 执行 监视 。 该 监视 组 件 必 须 既 是 目标 驱 
动 的 又 是 事件 驱动 的 ， 目 标 驱动 用 以 完成 任务 ， 事 
件 驱 动用 以 对 环境 变化 做 出 反应 。 过 程 推理 系统 
(PRS) 便 是 这 样 的 一 个 例子 ， 它 包括 一 个 过 
程 集 、 一 个 由 感知 和 系统 状态 演化 来 更 新 的 数据 库 
以 及 一 个 解释 器 ， 解 释 器 用 以 根据 数据 库 的 内 容 启 
动 适用 的 过 程 。 

PERTHE] 乌 都 被 开发 成 对 时 间 约 束 的 可 能 
响应 。 其 基本 思想 是 ， 算 法 操作 时 间 越 长 ， 其 解 越 接 
近 最 优 。 然 而 ， 如 果 缩 短 时 间 ， 算 法 也 能 产生 一 个 
解 ， 可 能 远 未 达到 最 优 ， 但 可 使 系统 继续 执行 而 不 用 
被 阻塞 等 待 决策 结果 。 随 时 算法 评价 解 的 质量 ， 并 用 
性 能 配置 文件 预测 该 质量 如 何 随 着 时 间 的 推移 而 被 
改善 。 


O 译 者 注 : 一 类 随时 可 以 中 断 执行 并 输出 近似 最 优 解 的 算法 。 


第 9 AMEE 173 


9.3 动作 规划 


本 章 余下 的 内 容 将 从 推理 方法 转向 两 类 推理 应 
用 ， 即 动作 规划 与 学 习 。 

从 传统 AI 的 意义 上 讲 ， 规 划 意 味 着 Agent 对 要 
达到 给 定 目 标 集 所 要 采取 的 一 系列 动作 进行 慎 思 ， 调 
度 意 味 着 给 动作 集 分 配 时 间 和 其 他 潜在 的 资源 ， 以 使 
满足 给 定 的 时 限 并 遵守 时 间 约 束 。 这 两 个 活动 在 概念 
上 是 不 同 的 ， 并 在 历史 上 常 被 以 级 联 方式 处 理 一 一 先 
规划 ， 再 调度 。 不 过 ， 最 近 随 着 更 多 高 效 时 序 推理 方 
法 和 规划 算法 的 出 更， 有 将 二 者 以 集成 方式 处 理 的 趋 
势 。 这 是 因为 ， 先 根据 一 些 指标 生成 最 优 规划 ， 再 为 
此 规划 设计 最 优 调度 ， 可 能 无 法 产生 一 个 时 间 和 资源 
上 都 是 最 优 的 调度 。 但 将 二 者 分 开 考 虑 也 是 有 意义 
的 ， 因 为 它们 并 不 总 是 需要 组 合 起 来 。 总 之 ， 本 书 将 
跳 过 调度 的 集成 ， 参 考 文献 [9.277] 第 信 部 分 有 一 
个 全 面 的 综述 。 

机 器 人 控制 已 在 规划 的 最 先 应 用 之 列 ， 如 
STRIPS 系统 ?2 21 就 已 被 用 来 为 SHAKEY”“” 机 器 人 
生成 规划 ( 即 待 执行 的 抽象 级 动作 序列 )。 在 机 器 人 
控制 体系 结构 中 ， 包 含 抽 象 动 作 的 规划 要 被 分 解 成 物 
理 操作 ， 这 些 物 理 操作 要 有 足够 的 柔性 ， 除 了 应 对 偶 
然 性 、 意 外 性 和 失效 外 还 要 能 实现 规划 ， 这 正如 人 对 
规划 的 智能 用 法 的 直观 期 望 一 样 。 业 已 证 明 ， 设 计 这 
样 一 种 机 器 人 控制 体系 结构 是 非常 重要 的 。 

本 部 分 内 容 从 如 何 为 规划 器 的 规划 域 建 模 人 手 ， 
然后 在 9. 3. 2 节 介 绍 在 很 多 简化 假设 下 高 效 工作 的 规 
划算 法 ，9. 3.3 节 松 弛 这 些 假设 ,处 理 不 确定 性 (如 
可 观测 性 缺失 ) 问题 ，9. 3.4 节 收 篇 简要 探讨 机 器 人 
规划 。 

想 全 面 了 解 动作 规划 有 关内 容 ， 推 荐 阅读 参考 文 
献 [9.27] ÆA 教科书 〈 如 参考 文献 [9.4] 中 的 
第 11、12、16 和 17 等 章节 ) 中 会 有 关于 动作 规划 的 
简介 。 参 考 文献 【9.31] 对 规划 方法 的 最 新 进展 有 
fj BE Ay BER, International Conference on Automated 
Planning and Scheduling (ICAPS) 是 目 前 本 领域 最 主 
要 的 国际 会 议 ， 每 年 召开 一 次 。PLANET 在 线 研究 数 
据 库 '* ”i 中 包含 一 系列 持续 更 新 的 体现 目前 发 展 水 平 
”的 规划 器 、 调 度 器 和 相关 工具 的 链接 。 参 考 文献 
[9.33] 中 包含 一 个 当前 现状 的 应 用 前 景 展望 以 及 一 
个 2003 年 末 时 对 这 一 领域 的 前 景 展望 。 


规划 域 描述 
Agent 对 行动 过 程 的 慎 思 需要 将 它 的 可 能 动作 都 


9.3.1 


表示 出 来 ， 包括 动作 执行 效果 、 对 环境 随时 间 变 化 保 
持 跟 踪 并 合理 处 理 任何 不 确定 性 和 缺少 信息 的 情况 。 
从 这 个 意义 上 讲 ， 规 划 涵 盖 了 本 章 中 前 面 介绍 的 各 种 
推理 方法 。 

慎 思 的 极端 形式 是 事前 进行 环境 仿真 ， 涉 及 
Agent 的 各 种 可 能 动作 ， 然 后 从 中 选择 出 看 起 来 最 好 
的 动作 予以 执行 。 实 际 上 ， 至 少 有 两 个 理由 可 以 说 明 
这 是 不 可 能 的 。 首 先 ， 通 常 并 非 真 实 仿真 所 需 的 全 部 
信息 都 是 可 用 的 ， 规 划 是 为 了 真实 环境 ， 其 中 许多 参 
数 都 是 未 知 或 不 可 知 的 ， 且 不 在 Agent 控制 之 下 ; 其 
次 ， 即 使 完全 仿真 的 全 部 信息 都 是 已 知 的 ， 但 是 很 有 
可 能 因为 计算 复杂 度 高 而 使 得 真实 环境 总 是 超前 于 仿 
真 。 因 此 ， 规 划 域 表示 要 故意 抽象 掉 很 多 或 大 部 分 细 
节 ， 以 便 使 得 有 效 规划 成 为 可 能 。 正 如 在 KR 的 所 有 
形式 中 一 样 ， 域 模型 的 精确 性 和 完备 性 需要 对 推理 速 
度 进行 折 中 。 

究竟 有 多 少 细 节 和 哪些 细节 要 表示 ， 这 是 建立 规 
划 系 统 时 要 做 出 的 工程 决策 。 因 此 ， 对 域 可 能 要 做 些 
简化 假设 ， 主 要 包括 : 有 限 性 ( 域 只 有 有 限 个 对 象 、 
动作 和 状态 ) ; 信息 完备 性 (规划 器 在 规划 时 具备 所 
有 相关 信息 ) ; 确定 性 (每 个 动作 的 执行 结果 都 是 确 
SEM); 瞬时 性 (动作 没有 持续 时 间 ); PRE CA 
划 期 间 环 境 不 发 生 改 变 ) 。 

通常 ， 限 制 性 假设 可 以 提高 算法 效率 ， 但 在 执行 
时 当 简 化 解 遭 过 真实 环境 时 便 可 能 出 现 问题 。 值 得 注 
意 的 是 ， 使 用 简化 域 模型 绝 不 意味 着 假定 环境 客观 上 
就 是 如 此 。 举 例 来 说 ,， 仅 对 标准 情况 (假定 最 简 情 
况 ) 进行 规划 然后 处 理 执行 时 发 生 的 各 种 异常 是 有 
意义 的 。 在 机 器 人 规划 中 ,这 种 思想 可 以 追溯 到 
SHAKEY! ”1, 

日 前 常用 的 域 表 示 法 主要 有 两 类 。 稍 后 会 介绍 
PDDL 型 的 描述 ，9. 3. 3 节 将 对 不 确定 域 表示 法 进行 
粗略 介绍 。 此 外 ， 与 这 两 类 域 表示 法 正 交 的 演绎 规 
划 有 多 种 形式 ， 它 们 使 用 纯 逻 辑 表示 法 的 一 些 变种 ， 
有 关 介 绍 内 容 可 参见 参考 文献 [9.27] 中 的 第 
12 章 。 

秉承 上 述 所 有 假设 的 简单 特点 ， 域 描述 主要 包含 
两 部 分 。 第 一 部 分 是 一 个 受 限 一 阶 谓 词语 言 < 的 规格 
说 明 ， 由 与 环境 建 模 有 关 的 表示 关系 的 谓词 符号 和 
表示 对 象 的 常量 构成 ; 第 二 部 分 是 一 个 动作 描述 集 
内， 对 于 每 个 动作 accA, BHAT prela) 和 后 件 
post(a) 构成 ， 前 件 即 < 中 的 事实 集 ， 当 其 值 为 真 时 
a 方 可 执行 ; 后 件 也 是 £ 中 的 事实 集 ( 正 的 或 负 的 )， 
执行 a 后 其 值 变 为 真 。 

举 个 简单 的 例子 ( 源 自 参 考 文献 [9.27] 第 35 
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页 ) ， 表 9.1 给 出 了 在 相 邻 接 的 位 置 1 到 位 置 m 移动 
机 器 人 7 的 动作 图 式 。 在 规划 过 程 中 ， 通 过 用 常量 对 
象 代 换 变量 ， 动 作 图 式 被 实例 化 成 规划 中 发 生 的 
动作 。 


表 9.1 相 邻 接 的 位 置 ! 到 位 置 m 移动 
Plas A r 动作 图 式 

( :action move 

: parameters (? r-robot ? 1 ? m-loca- 
tion) 

: precondition (and (adjacent ? 1 ? m) 
(at? r? 1) 

(not(occupied ? m))) 

:effect(and(at ? r ? m)(occupied ? m) 

(not(occupied ? 1))(not(at ? r? 1)))) 


给 定 一 个 域 ， 那 么 一 个 具体 的 规划 问题 就 用 . 语 
言 由 下 列 组 件 确定 : 

1) 初始 状态 7， 是 -语言 中 在 开始 执行 之 前 即 为 
真 的 所 有 事实 的 集合 。 

2) 目标 条 件 G6， 是 了 语言 中 由 执行 一 个 规划 所 
诱导 的 事实 集 。 

在 该 框架 下 的 规划 是 典型 的 实际 动作 〈 自 由 变 
E) 的 偏 序 集 ， 这 些 实际 动作 是 要 按照 顺序 执行 的 。 

规划 域 描述 语言 (PDDL) 叫 2 是 目前 用 于 描述 规 
划 域 的 事实 上 的 标准 。 实 际 上 ，PDDL 代表 着 一 整 类 
语言 ， 人 允许 或 禁止 诸如 参数 类 型 、 恒 等 处 理 、 条 件 动 
作 效 果 以 及 一 些 FOPL 语句 的 限制 形式 等 特征 。 举 一 
个 条 件 结 果 的 例子 ， 考 虑 机 器 人 在 move 动作 中 可 不 
可 以 加 载 一 些 容器 “? ce”， 那 么 ,作为 一 个 附加 结 
果 指 定 “? c” 将 随机 器 人 移动 : 


(when({ loaded ? r? c) 
% condition 
(and(at ? c ? m)(not(at ? c? 1)))) 
% effect. 


除了 上 述 形式 ， 原 始 的 PDDL 还 有 些 扩展 版 本 ， 
其 中 PDDI2. 1 是 最 值得 一 提 的 ， 它 允许 信息 被 表 
示 成 时 序 规划 ， 如 ， 人 允许 动作 有 持续 时 间 。 

规划 是 计算 困难 的 。 对 于 PDDL 型 问题 的 命题 恋 
种 〈 即 用 有 限 的 语言 2) ， 规 划 的 存在 性 当然 是 可 判 
定 的 ， 但 求解 规划 问题 是 P 空间 完全 的 。 


9.3.2 偏 序 规划 生成 
许多 规划 系统 及 其 基础 规划 算法 都 接受 前 已 述 及 


的 限制 性 假设 ， 即 信息 的 完备 性 、 确 定性 、 瞬 时 性 和 
停 清 性 ， 因 此 ， 刚 才 给 出 的 规划 问题 的 定义 都 适用 。 
于 是 ， 要 找 的 那 种 规划 就 是 一 个 动作 集 ， 通 过 执行 这 
些 动作 可 将 初始 情境 变换 到 目标 条 件 为 真 的 情境 
(目标 情境 不 必 瞧 一 ) 。 对 此 规划 模型 不 必 做 有 限 性 
假设 ， 但 为 简化 起 见 我 们 还 是 要 这 样 做 ， 这 意味 着 所 
有 动作 实例 可 以 被 假设 为 是 真实 的 。 

通常 ， 规 划 中 的 动作 不 能 以 任意 顺序 随意 执行 ， 
但 也 必须 按 一 定 的 顺序 执行 ， 以 确保 每 个 动作 的 所 有 
前 件 在 该 动作 执行 的 一 刻 为 真 。 这 个 顺序 不 必 是 全 序 
的 或 线性 的 , 但 可 以 是 偏 序 的 或 非 线 性 的 。 相 应 类 型 
的 规划 被 称 为 非 线性 或 偏 序 规划 ， 总 之 ， 定 义 为 一 个 
动作 实例 集 4 和 偏 序 关 系 < 对 <4，< > 。 无 序 动作 
可 以 以 任意 顺序 执行 ， 考 虑 到 动作 建 模 ， 它 们 也 可 以 
并 发 执行 ， 这 意味 着 在 同一 个 原子 时 间 步 内 执行 
(假设 具备 瞬时 性 ) 。 

对 于 一 个 规划 ， 作 为 给 定 规划 问题 的 一 个 解 ， 每 
个 动作 cs 4， 在 每 个 与 < 兼容 的 可 能 执行 顺序 中 都 
需要 其 前 件 为 真 ， 按 任何 一 种 可 能 顺序 执行 之 后 ， 目 
标 条 件 必须 为 真 。 

A 20 世纪 七 八 十 年 代 的 一 阶 偏 序 规划 方法 开始 ， 
到 SNLP (系统 非 线 性 规划 ) 算法 21 及 其 衍生 算法 
达到 是 峰 状 态 ， 一 系列 高 效 的 偏 序 规划 算法 应 运 而 
生 ， 这 些 算法 通过 各 种 技术 来 提高 效率 ， 如 系统 化 、 
反 向 链 、 最 小 承诺 、 密 集 推理 等 。 参 考 文献 [9.4] 
中 的 第 11.3 节 对 此 作 了 介绍 ， 并 提供 了 一 些 参考 文 
献 。 按 这 条 线 下 来 的 方法 通常 被 称 为 传统 规划 。 

下 面 是 生成 一 个 解 规划 的 算法 思想 : 从 仅 包含 初 
始 事实 和 目标 条 件 的 空 规 划 开 始 ， 迁 代 检 查 在 当前 规 
划 中 出 现 的 所 有 条 件 在 所 有 < 允许 的 执行 顺序 中 是 否 
为 真 ， 如 果 发 现 某 条 件 c 还 不 满足 ， 可 以 通过 以 下 两 
种 方法 来 处 理 : 或 者 插 人 一 个 新 的 动作 作为 结果 生成 
c， 或 者 调整 规划 中 已 有 的 一 个 动作 使 e 在 需要 的 时 
候 变 为 真 。 如 果 所 有 动作 彼此 独立 ， 这 样 工 作 起 来 效 
率 会 很 高 ， 但 通常 它们 并 不 独立 一 一 一 个 c 一旦 在 规 
划 中 实现 ， 它 就 会 由 于 某 个 动作 结果 中 包括 ~ e 而 威 
胁 到 其 后 的 条 件 。 传 统 规划 系统 中 ， 人 们 在 算法 规则 
或 启发 式 方面 做 了 不 少 努 力 ， 探 究 了 如 何 有 效 阻止 或 
处 理 规划 中 的 子 目标 相互 作用 。 

将 子规 划 预 定义 为 宏 是 很 多 应 用 系统 中 都 采用 的 
技术 ， 宏 在 规划 内 形成 一 种 分 层 结构 ， 由 此 得 名 分 层 
任务 网 络 (HTN) ,参考 文献 [9.27] 中 第 11 章 对 
此 有 介绍 。 形 式 上 ， 子 规划 可 以 表示 成 任务 ， 即 带 有 
前 件 和 后 件 的 动作 ， 规 划 时 可 以 拓展 到 其 底层 子规 
划 。 任 务 可 以 分 层 。 只 要 还 包含 未 扩展 的 任务 ， 规 划 
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就 没有 完成 。 之 所 以 使 用 HTN 是 由 于 规划 域 建 模 者 
知道 ,通常 (实际 上 , 在 所 有 的 实际 应 用 中 ) 反复 
使 用 的 子规 划 不 必 由 规 划 器 每 次 从 头 开 始 构造 。 而 
AL, HTN 的 分 层 特 性 可 以 使 更 大 规模 的 规划 以 易于 
人 管理 的 方式 展现 出 来 。HTN 已 被 用 了 很 长 时 间 ， 
效果 甚 佳 。STPE (交互 规划 与 执行 监控 系统 ) 扩 ”是 
其 中 适用 于 实际 应 用 的 首选 规划 内 ,最 近 的 SHOP 
(简单 分 层 有 序 规划 器 ) 2 是 其 中 的 佼佼 者 。 

从 GRAPHPLAN "4 开始， 这 一 领域 便 致力 于 开 
发 偏 序 规划 算法 (被 参考 文献 【9.27] 称 为 新 传统 
规划 ) 的 相关 技术 ， 偏 序 规划 算法 背离 了 传统 算法 ， 
而 保持 生成 顶级 性 能 规划 器 。 下 面 将 详细 介绍 其 中 的 
两 个 方法 ， 即 规划 图 和 变换 成 可 满足 性 问题 。 

近来 对 规划 器 性 能 的 改善 大 部 分 都 归功 于 把 规划 
形式 化 为 一 类 特殊 的 搜索 问题 ， 于 是 强 有 力 的 局 发 式 
方法 便 可 派 上 用 场 ， 详 见 参 考 文 献 [9.27] BM 
部 分 。 

1. 规划 图 

GRAPHPLAN 的 关键 思想 之 一 是 从 预 处 理 阶 段 开 
始 构建 规划 ， 即 : 

1) 确定 在 n 个 时 间 步 内 可 解 的 必要 条 件 ( 其 中 
n 在 找到 解 之 前 一 直 递 增 )。 

2) 输出 一 个 结构 化 表示 ， 如 果 存 在 一 个 n 时 间 
步 偏 序 规划 ， 便 可 基于 此 结构 将 其 相对 高 效 地 抽取 
出 来 。 

这 种 结构 便 是 规划 图 (PG) ， 即 一 个 真实 事实 节 
点 和 真实 动作 节点 的 分 层 有 向 无 环 二 部 图 ， 其 中 事实 
节点 和 动作 节点 的 层次 可 以 互 换 。 图 9.3 给 出 了 有 3 
个 接续 层 的 示意 图 。 

Ai Fii A; F; A js 
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图 9.3 一 个 规划 图 结构 (图 图 代表 事实 节点 ， 
矩形 框 代表 动作 节点 ， 小 方 框 代表 伪 算 子 ) 


第 一 层 Fy 由 代表 问题 完全 初始 情境 的 全 部 事实 
节点 构成 ， 最 后 一 层 也 是 事实 层 。 当 且 仅 当 事 实在 动 
作 前 件 之 中 时 ， 用 边 连 接 相 应 事实 节点 和 动作 节点 ; 
当 且 仅 当 事实 在 动作 结果 中 时 ， 将 动作 节点 与 事实 节 
点 相连 。 除 了 域 描述 的 动作 集 4，PG 还 包括 伪 动 作 
用 于 将 事实 层 的 每 个 事实 复制 到 下 一 个 事实 层 (在 
语法 上 , f 的 伪 动 作 与 1 具有 完全 一 样 的 前 件 和 结 
果 ) 。PG 在 任 一 4, 层 中 包含 动作 节点 (对 应 可 用 的 
全 部 动作 ) ， 给 定 F, WB, F, 包含 所 有 A, 动作 后 
件 中 包含 的 全 部 事实 。 

对 于 一 个 给 定 的 有 限 的 规划 问题 ，PG 是 由 层 内 
节点 序列 唯一 确定 的 。 它 无 需 搜 索 就 可 扩展 ， 只 需 从 
最 后 一 个 事实 层 向 前 链接 ， 把 所 有 适用 的 动作 插入 到 
下 一 个 动作 层 ， 将 这 些 动作 的 结果 插 和 人 到 下 一 个 事实 
层 。 动 作 和 事实 集 随 着 层 数 单调 增长 ， 因 此 PG 的 生 
成 可 以 在 有 限 域内 终止 。 

规划 问题 可 解 的 必要 条 件 是 存在 一 个 事实 层 包含 
所 有 目标 事实 。 如 果 能 在 n 个 时 间 步 发 现 该 层 ， 
PG 暂停 扩展 并 尝试 提取 规划 ， 向 后 收集 解 规划 。 从 
F, 层 中 的 目标 事实 开始 ， 追 滴 Ff,_, 层 中 的 动作 4 的 
MF, MER F, 中 事实 所 需 的 每 个 动作 A, 中 选 出 一 
系列 动作 。 

规划 的 提取 不 一 定 能 成 功 ， 因 为 所 需 动 作 可 能 在 
共同 的 动作 层 中 相互 排斥 一 一 与 传统 规划 中 的 子 目标 
相互 作用 类 似 。 因 此 ， 某 F, 中 的 目标 条 件 只 是 可 解 
的 必要 条 件 ， 而 非 充分 和 条件。 一般 情况 下 ， 从 PG 中 
提取 规划 要 用 到 搜索 ， 尽 管 比 传统 规划 算法 中 的 搜索 
空间 要 小 得 多 ,但 通常 远 远 超过 最 初 构建 PG. 

PG 的 主要 缺点 是 它们 要 求 域 有 限 的 〈 即 命题 
的 ) ， 而 且 ， 其 语言 必须 大 小 有 限 ， 因 为 所 有 的 
事实 和 动作 实例 都 要 为 扩展 PG 而 明确 地 构建 
出 来 。 

2. 作为 可 满足 性 问题 的 规划 

从 规划 研究 的 早期 开始 ， 人 们 就 已 经 尝试 把 规 
划 生 成 问题 表示 成 传统 逻辑 中 的 推理 问题 ?1 。 这 
样 做 因为 两 个 原因 也 许 很 有 用 : 首先 ， 已 有 有 效 的 
逻辑 推理 器 对 规划 可 能 有 用 ， 节 省 了 研究 专门 规划 
算法 的 气力 ; 其 次 ， 域 中 的 逻辑 推理 将 被 无 锋 集 成 
到 规划 中 ， 从 而 可 以 白白 得 到 一 种 强 有 力 的 域 表 
示 法 。 

FOPL 中 对 变化 与 不 变 的 有 效 表 示 已 经 被 归 为 框 
架 问 题 号 ， 详 见 参考 文献 [9.4] 的 第 10.3 节 的 介绍 。 
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同时 ， 有 若干 种 方法 以 各 种 逻辑 形式 来 表示 规划 问 
题 ， 并 有 一 些 演绎 规划 器 在 那个 时 代 达 到 了 顶级 性 
能 。 例 如 ，TALplanner "采用 了 时 序 逻 辑 表示 法 ， 
Blackbox "和 采用 命题 逻辑 编码 ， 其 规划 算法 结合 了 
PG. 命题 逻辑 编码 为 使 用 有 效 的 模型 检查 器 (参见 
9.1) 进行 推理 提供 了 选择 。 这 对 PG 任何 时 候 都 
是 适用 的 。 参 考 文献 [9.27] 中 的 第 7 章 对 此 进行 
了 介绍 。 

有 限 规 划 问 题 的 命题 表示 法 可 以 从 给 定 域 和 问 
题 描述 比照 先 验 图 式 得 出 ， 如 同 为 Blackbox 开发 的 
方法 一 样 。 事 实 被 指定 附加 的 情境 参数 ， 带 有 在 情 
境 间 迁 移 的 动作 。 初 始 事实 、 目 标 事实 和 动作 结果 
的 命题 逻辑 表示 很 简单 。 令 人 感 兴趣 的 部 分 (参见 
9.2.1 节 ) 由 解释 性 框架 公理 构成 ， 即 一 个 形式 化 
公理 集 ， 两 种 情境 间 事 实 真 值 的 任何 变化 都 需要 应 
用 动作 做 出 解释 ， 在 该 动作 的 结果 中 具有 改变 的 事 
实 值 。 


9. 3.3 不 确定 性 规划 


虽然 信息 完备 性 、 确 定性 和 停滞 性 在 某 个 抽象 级 
对 规划 域 通常 是 有 用 的 近似 ， 但 在 其 他 情形 却 未 必 有 
用 ， 而 这 绝 不 意味 着 正好 相反 的 情形 就 是 对 的 ， 这 种 
情况 下 ， 规 划 几 乎 也 就 没什么 意义 了 。 很 多 域 表 现 出 
未 知 的 、 随 机 的 和 动态 的 一 面 ， 但 依然 提供 一 定 程度 
的 信息 和 控制 ， 利 用 这 个 来 弥补 信息 和 控制 的 不 足 便 
是 不 确定 性 规划 的 思想 ， 根 据 域 模型 不 完整 性 的 内 容 
和 程度 ， 有 不 同 的 形式 ， 本 节 扼 要 介绍 其 中 的 一 种 ， 
详细 介绍 可 以 参见 参考 文献 [9.27] 的 第 V 部 分 和 
参考 文献 [9.4] 的 第 12、16 和 17 章 。 参 考 文献 
[9.44] 第 了 部 分 介绍 了 机 器 人 环境 中 的 概率 规划 技 
术 。 参 考 文献 【9.45] 建立 了 前 述 的 传统 规划 和 各 
种 不 确定 性 规划 的 统一 视图 。 

假定 某 些 动作 可 能 具有 不 确定 性 结果 ， 旦 这 些 结 
果 出 现 的 相对 频率 信息 (近似 的 或 估计 的 ) 可 用 。 
在 这 种 情况 下 ， 概 率 框架 下 的 表示 法 便 应 运 而 生 ， 如 
马尔 可 夫 决 策 过 程 (MDP), MP 用 有 限 状 态 集 5、 
有 限 动作 集 4 和 动作 模型 表示 域 。 动 作 模 型 设 定 : 对 
FR acd, 在 状态 ;执行 a 终止 于 状态 s' 的 条 件 概 
率 分 布 为 P,(s' | s)。 例 如 ， 假 定 机 器 人 的 当前 位 置 
是 状态 描述 的 一 部 分 ， 从 当前 位 置 ! 移动 到 邻接 的 自 
由 位 置 m 的 高 屋 动作 成 功 移动 到 m 的 情况 占 95% , 
未 指定 (可 能 是 未 知 ) 的 条 件 使 机 器 人 留 在 位 置 ! 的 
情况 占 剩 下 的 5% 。 

状态 伴随 着 效用 ， 动 作 的 耗费 可 以 建 模 成 结果 状 
态 的 负 效 用 。 在 这 种 框架 下 的 规划 意味 着 要 寻找 一 个 








动作 序列 ， 不 仅 考虑 到 每 个 算 子 的 惟一 标准 结果 ， 和 而 
且 考 虑 到 所 有 可 能 的 结果 ， 包 括 那 些 不 太 可 能 但 会 产 
生 很 大 耗费 的 结果 (考虑 在 一 个 陡峭 的 楼 梯 附 近 轮 
式 平 台 可 能 的 运动 误差 ) 。 

在 此 框架 下 的 规划 就 是 决策 论 中 的 策略 ， 即 从 状 
态 映 射 到 动作 的 函数 。 基 本 规划 算法 有 值 迄 代 (VI) 


和 策略 迄 代 (PI， 见 参考 文献 [9.4] 第 17 章 )。 对 


有 限 状态 集 ， 二 者 都 收敛 到 最 优 策略 。 其 差别 是 VI 
是 通过 通 近 给 定 状 态 最 优 策略 的 真实 效用 来 实现 的 ， 
而 PI 只 寻找 最 优 策略 ， 节 省 了 确定 其 精确 效用 值 的 
气力 。 

MDP 还 假设 状态 在 执行 时 是 可 观察 的 ， 即 Agent 
能 够 确切 知道 自己 处 于 什么 状态 ， 并 能 在 策略 中 确 
切 地 选取 相应 的 分 支 ， 这 在 一 些 机 器 人 应 用 中 可 能 
不 方便 。 进 一 步 跳 过 可 观测 性 假设 ， 便 引出 了 部 分 
可 观测 MDP (POMDP), POMDP 在 MDP 中 增加 一 
个 观测 模型 ， 由 Agent 进行 的 可 能 观测 的 有 限 集 0 
及 在 状态 s 观察 o 的 条 件 概 率 P(o |s) 构成 。POM- 
DP 也 被 用 于 移动 机 器 人 定位 与 标 图 的 形式 模型 ( 见 
第 37 章 ) 。 

POMDP 的 最 优 策略 是 仿照 MDP 来 定义 的 ， 但 人 
们 发 现 它 们 计算 困难 。 一 种 常用 的 方法 是 考虑 信念 空 
间 而 不 是 状态 空间 ， 即 状态 空间 上 的 概率 分 布 空间 ， 
对 应 Agent 在 执行 一 个 动作 或 观测 之 后 对 自己 可 能 处 
于 状态 空间 中 的 位 置 的 信念 。 信 念 空间 是 完全 可 观测 
AY (Agent 确切 知道 其 信念 )， 因 此 POMDP 可 以 变换 
成 信念 空间 上 的 MDP, TÆ VI 和 PI 算法 便 可 用 了 。 
言 念 空 间 以 指数 级 大 于 状态 空间 ， 且 是 连续 的 。 因 
此 ， 只 有 小 状态 空间 上 的 POMDP 可 以 用 这 种 方式 有 
效 处 理 。 还 有 些 通 近 方法 ， 见 参考 文献 [9.4] 的 第 
17 章 。 


9.3.4 Hla AMR 


机 化 人 规划 (或 基于 规划 的 机 器 人 控制 ) 一 词 
在 AI 领域 中 是 指 在 机 器 人 (通常 指 自主 移动 机 器 
A) 控制 软件 中 使 用 前 述 规划 方法 ， 并 非 意味 着 要 
替换 机 器 人 技术 中 现 有 的 运动 或 路 径 规划 方法 (S 
见 第 5 章 、 第 26 章 和 第 35 章 ) ， 而 是 对 更 一 般 的 动 
作 规划 做 些 补充 。 在 机 器 人 控制 中 使 用 规划 有 若干 目 
的 ， 无 论 这 些 规 划 是 由 机 器 人 在 线 自动 生成 的 ， 还 是 
从 规划 库 中 取出 的 。 提 供 一 种 高 度 细 化 的 机 器 人 操作 
描述 ， 可 用 于 优化 全 部 行为 ， 可 用 于 如 任务 级 脖 操 作 
一 样 与 人 交互 ， 可 用 于 如 多 机 器 人 协调 (参见 第 40 
章 ) 中 的 一 样 与 伙伴 机 器 人 通信 ， 可 用 于 在 高 粒度 
块 中 学 习 复 杂 的 动作 结构 ， 可 用 于 根据 环境 变化 自 适 
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应 行为 ， 也 可 在 不 同 的 应 用 规模 上 通过 为 程序 员 提 供 
一 种 有 意义 的 抽象 层 而 用 于 机 器 人 控制 编码 工程 。 参 
考 文献 [9.27] 第 20 章 阐 述 了 这 些 目 的 ,参考 文献 
[9.46] 收集 了 跨越 这 些 目 的 的 研究 论文 ， 参考 文献 
[9.33] 第 5 章 对 本 领域 最 近 的 应 用 前 景 进行 了 
展望 。 

由 于 机 器 人 动作 规划 的 目的 和 抽象 级 别 多 种 多 
样 ， 没 有 哪 一 种 单一 的 规划 方法 能 与 之 完全 对 应 上 ， 
当然 任何 一 种 规划 方法 又 都 有 用 。 于 是 ， 机 伸 人 规划 
一 词 通常 被 按照 参考 文献 19.47] 中 表述 的 宽泛 含义 
使 用 ， 即 “是 机 器 人 程序 的 一 部 分 ， 机 器 人 对 其 未 来 
的 执行 进行 显示 的 推理 ”"。 无 论 机 器 人 采用 哪 种 规划 ， 
对 闭环 执行 和 监控 都 有 需求 ， 从 规划 方法 学 的 角度 看 ， 
机 器 人 规划 的 内 容 就 源 自 这 些 需求 。 从 技术 上 讲 ， 这 
些 需 求 形成 了 对 机 器 人 规划 的 约束 ， 尤 其 是 对 域 语言 、 
动作 形式 化 及 机 器 人 控制 体系 结构 的 约束 。 

给 定 规划 域 的 域 语 言 < 通 常 是 精心 地 手工 构建 
的 ， 因 为 糟糕 的 设计 决策 可 能 使 同样 规划 做 的 规划 时 
间 有 着 天 壤 之 别 。 对 于 机 器 人 规划 ， 还 有 另外 一 个 问 
题 : 命题 〈 至 少 那些 为 规划 生成 和 执行 监控 而 需 观 
测 的 命题 ) 需要 完全 依靠 传感器 数据 来 有 效 确定 。 
一 般 而 言 ， 这 便 是 AI 中 符号 接地 问题 “” (参见 
9.1 节 )。 目 前 解决 此 问题 最 务实 的 做 法 是 将 域 语言 
的 动态 部 分 限制 到 可 以 被 有 效 监控 的 命题 上 。 

动作 形式 化 最 好 应 支持 规划 生成 和 执行 监控 ， 因 
此 要 有 足够 的 表达 能 力 ， 比 如 类 似 于 实时 规划 语言 ， 
此 外 还 要 有 足够 的 限制 以 对 规划 进行 有 效 推理 。 参 考 
文献 [9.48] 讨论 了 这 些 问 题 ， 并 对 已 有 方法 进行 
了 较 小 范围 的 综述 。 

最 后 ， 机 器 人 控制 体系 结构 必须 确定 规划 过 程 和 
规划 结果 要 被 适当 地 集成 到 整个 机 器 人 控制 中 。 特 别 
是 来 自 新 近 规划 (如 果 有 ) 的 建议 与 来 自 其 他 控制 
组 件 〈 如 并 发 反应 行为 组 件 ) 的 任何 活动 必须 能 有 
效 协商 ， 详 见 第 8 章 。 


9.4 ”机 器 人 学 习 


机 器 学 习 是 Al 研究 领域 中 最 受 关注 的 问题 之 一 ， 
学 习 与 智能 之 间 的 联系 是 显而易见 的 。 学 习 程 序 的 首 
例 是 1959 年 Samuel 编写 的 西洋 棋 程 序 。 学 习 的 定义 
本 身 与 智能 的 定义 一 样 具 有 一 般 性 ， 它 基本 上 可 以 表 
述 为 基于 经 验 改善 系统 自身 性 能 或 知识 的 能 力 。 在 
AT 中 ， 典 型 的 学 习 方 法 主要 是 通过 演绎 、 归 纳 或 类 
比方 法 操作 符号 表示 以 产生 新 知识 。 统 计 学 习 洱 次 了 
数据 分 类 方法 〔( 即 从 样本 推导 模型 )， 这 是 在 机 器 人 


技术 及 其 他 领域 中 广泛 使 用 的 学 习 方 法 。 如 果 表 示 法 
是 概率 的 ， 就 采用 贝 叶 斯 推理 。 神 经 网 络 (基于 生 
物 神经 元 的 形式 模型 ) 涵盖 了 与 统计 学 习 相关 的 数 
据 分 类 技术 。 

强化 学 习 是 另 一 种 在 机 器 人 中 比较 流行 的 学 习 方 
法 ， 它 与 MDP 和 动态 规划 密切 相关 。 它 主要 是 采用 
与 每 个 机 器 人 动作 关联 的 强化 信号 (奖赏) 来 对 正 
确 响 应 进行 强化 。 

学 习 也 可 以 根据 系统 动作 后 是 否 有 教师 能 显 式 提 
供 正确 答案 ( 即 ， 能 对 系统 进行 奖惩 或 只 有 系统 目 
身 性 能 可 用 。) 而 分 成 有 监督 和 无 监督 两 兴 。 

本 节 综 述 了 机 器 人 领域 感 兴趣 的 最 重要 的 学 习 方 
法 。 学 习 在 机 器 人 控制 中 的 应 用 贯穿 本 书 始 终 ， 如 第 
37 章 学 习 标 图 、 第 60 章 学 习 复 杂 的 马达 协调 模式 以 
及 第 61 章 的 演化 学 习 。 


9.4.1 归纳 逻辑 学 习 


归纳 逻辑 规划 (ILP)“”*” 是 主要 的 有 监督 符号 
学 习 方 法 之 一 ， 它 是 基于 逻辑 表示 法 和 一 阶 逻辑 推理 
的 ， 并 使 用 上 下 文 知识 ， 即 已 经 获得 的 知识 。ILP 的 
目标 是 给 定 返回 真 或 假 值 变量 集 和 所 谓 的 背景 知识 来 
综合 〈 或 学 习 ) 逻辑 程序 ， 程 序 对 观测 形成 一 个 解 
释 。 这 些 程序 当然 不 是 唯一 的 。 因 此 ， 其 难点 在 于 寻 
找 与 数据 兼容 的 最 小 〈 充 分 必要 的 ) 程序 ， 即 对 正 
变量 返回 真 、 对 负 变 量 返 回 假 。 该 程序 也 必须 能 被 泛 
化 ， 即 应 用 到 新 的 实例 上 时 能 产生 正确 答案 。 一 般 而 
言 ，IPL 并 不 容易 处 理 。 参 考 文献 [9.4] 中 的 第 
19.5 节 对 此 作 了 介绍 。 


9.4.2 统计 学 习 与 神经 网 络 


统计 学 习 被 广泛 用 于 机 器 人 和 计算 机 视觉 领域 ， 
涵盖 了 诸如 贝 叶 斯 学 习 、 核 方法 和 神经 网 络 等 若干 技 
术 。 它 以 从 数据 中 学 习 模 型 为 目标 将 模式 划分 到 类 别 
中 ， 数 据 被 看 成 随机 变量 ， 数 据 的 值 为 模型 提供 了 采 
样 。 首 先 要 有 一 个 训练 阶段 ， 此 阶段 中 将 数据 集 及 关 
联 标签 提 呈 给 算法 (有 监督 学 习 ) 。 然 后 算法 会 自己 
对 数据 进行 标注 。 训 练 阶段 的 目标 是 最 小 化 分 类 误差 
(或 风险 ， 或 期 望 损失 ) 。 推 荐 阅读 参考 文献 [9.4] 
第 20 章 进 行 一 般 了 解 。 

贝 叶 斯 学 习 是 贝 叶 斯 规则 的 一 种 应 用 一 一 根据 给 
定数 据 计 算 给 定 假设 (数据 所 属 的 类 别 标 签 ) 的 概 
率 。 训练 阶段 提供 数据 对 每 一 类 的 似 然 程度 
P(d |C) 。 分 类 还 需要 类 分 布 的 先 验 知识 P(C), 2 
样 才 能 应 用 贝 叶 斯 规则 。 贝 叶 斯 学 习 有 若干 变种 ， 如 
极 大 似 然 法 (ML) 和 期 望 最 大 化 算法 (EM) 。 贝 叶 
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斯 技术 具有 中 等 计算 耗费 ,易于 实现 ,但 不 能 在 线 
学 习 。 

神经 网 络 CNN) 由 加 权 连 接 的 基本 计算 单元 
(神经 元 ) 构成 。 每 个 单元 计算 其 输入 的 加 权 和 ， 如 
RATER (AH Sigmoid 函数 ) 则 激活 或 点 
火 ， 这 便 具备 了 分 类 器 的 基础 。 最 常用 的 前 馈 网 络 的 
基本 结构 包括 一 个 输入 层 、 一 个 或 多 个 隐 层 以 及 一 个 
输出 层 。 通 过 连接 权重 ，NN 的 输出 便 构成 其 输入 的 
PRIS NN 的 训练 就 是 调整 权重 以 对 数据 正确 分 类 
(有 监督 学 习 )。 与 贝 叶 斯 学 习 相 比 ， 神 经 网 络 没 有 
洞察 分 类 器 的 内 部 ， 但 可 以 在 线 学 习 。 


9.4.3 强化 学 习 


强化 学 习 (RL) 是 一 种 通过 对 环境 施加 动作 并 
由 环境 反馈 奖赏 信号 的 无 监督 学 习 方 法 。 参 考 文献 
[9.50] 是 很 重要 RL 文献， 参考 文献 [9.4] 中 的 第 
21 章 也 有 一 般 性 介绍 。 在 RL 中 ,机 器 人 或 Agent 的 
目标 是 学 习 最 佳 策 略 ， 即 达到 给 定 目 标的 动作 序列 。 
为 此 ， 必 须 最 大 化 累积 奖赏 值 ，RL 的 形式 框架 因此 
与 MDP 的 相同 。 机 器 人 在 集合 S 中 感知 (有 时 是 部 
分 感知 ) 环境 状态 ， 并 能 完成 集合 4 中 动作 ， 这 些 
动作 的 序列 便 形成 策略 r。 从 一 个 状态 执行 一 个 给 定 动 
作 到 下 一 个 状态 有 一 个 转移 概率 Pl, =s | s ，a)。 机 
器 人 努力 最 大 化 一 个 值 函数 V，V 表示 奖赏 值 > 随时 
H PRAHA, Bellman 方程 是 表达 值 函 数 并 使 最 优 
策略 or * 能 够 学 习 的 基本 方程 。 


V* (s) = max[ r(s,a) +y > P(s' | s,a)V"* (s')] 


(9.1) 
BP, r(s, a) 为 立即 奖赏 ， 折 扣 因子 y 将 未 来 的 预 
期 奖赏 纳入 考虑 范围 。Q- 学 习 “”… 是 计算 最 优 策略 
的 一 个 变种 ， 其 思想 是 学 习 动作 的 值 而 不 是 状态 
的 值 。 
大 部 分 RL 研究 工作 都 假定 动作 空间 是 离散 的 ， 
已 给 出 的 学 习 过 程 本 身 的 形式 并 不 能 直接 应 用 于 连续 
动作 空间 。 要 将 RL 应 用 于 连续 空间 ， 一 种 常用 的 做 
法 是 采样 。 


9.5 结论 与 扩展 阅读 


AM AI 遍 露 头角 那天 起 ， 便 将 自主 机 器 人 列 入 
其 研究 日 程 。 在 20 世纪 90 年 代 ， 当 移动 机 器 人 平台 
广泛 使 用 且 价 格 可 以 接受 时 ， 很 多 实验 室 完 成 了 最 初 
的 实验 。AI 对 待机 器 人 技术 的 态度 非常 明确 ， 就 是 


为 Agent 的 计算 模型 (包括 感知 、 推理 和 动作 执行 ) 
提供 一 个 有 用 的 试验 床 ， 因为 机 器 人 能 在 完整 的 集成 
中 检验 这 些 模 型 。 

这 与 AI 对 机 器 人 技术 的 长 远 观 点 相似 ， 都 是 要 
开发 能 为 智能 自主 机 器 人 闭环 控制 器 有 点 贡献 的 方法 
和 工具 。 但 如 今 Al 推理 方法 对 机 器 人 技术 的 贡献 是 
什么 呢 ? 

这 里 已 经 学 到 了 两 点 体会 。 第 一 ， 已 经 介绍 过 的 推 
理 方法 十 分 易 懂 日 高 效 ， 目 前 已 能 够 安全 且 有 用 地 用 作 
机 器 人 Agent 闭环 控制 的 一 部 分 。RoboCup 中 型 足球 联 
赛 便 是 很 壮观 的 一 个 例子 ， 美 国 国家 航空 航天 局 
(NASA) 远程 Agent 任务 ”” 自主 控制 功能 是 另外 一 例 。 

第 二 ， 感 知 、( 基 于 符号 的 ) 推理 和 动作 执行 的 
完全 闭环 集成 需要 解决 符号 接地 问题 *' (其 中 的 真 
实 部 分 ) 。 即 ， 必 须 理 解 机 器 人 如 何 能 按照 用 于 推理 
和 动作 规划 的 语义 范畴 去 感知 环境 。 理 解 符号 接地 的 
过 程 完全 处 于 AI 及 与 此 有 关 的 所 有 认 知 科学 的 大 问 


.十 之 中 。 因 此 机 器 人 技术 最 好 别 再 等 待 AI 先行 找到 


一 般 的 解决 方案 。 这 期 间 ， 机 器 人 可 以 在 闭环 控制 中 
使 用 AI 推理 方法 ， 只 要 有 用 就 行 ， 别 管 所 需 的 数据 
在 哪里 可 以 得 到 。 

为 总 结 本 章 ， 我 们 回 到 机 器 人 控制 体系 结构 的 问 
题 上 ， 突 出 功能 集成 与 物理 集成 的 基本 观点 。 为 了 这 
一 回顾 之 目的 ， 我 们 将 推理 看 成 是 一 种 或 一 套 必须 依 
赖 以 下 来 源 提 供 信 息 的 方法 : 第 一 , 域 建 模 者 
(A); 第 二 ,为 以 符号 形式 提供 域 当前 状态 的 最 新 
信息 而 进行 的 在 线 感知 ，( 可 能 还 会 有 ) 第 三 ， 泛 化 
恕 往 经 验 帮助 对 自身 进行 识别 或 推理 的 学 习 器 。 这 种 
观点 实际 上 有 点 鼠 目 寸 光 。 一 个 完全 集成 的 机 器 人 推 
理 器 应 该 通过 提供 假设 来 帮助 其 他 模块 ， 如 ， 感 知 模 
块 可 能 正在 其 传 感 数 据 中 找 什么 (如 果 你 告诉 我 你 
已 经 确定 了 水 槽 和 洗 碗 机 ， 那 么 我 告诉 你 ， 我 们 可 能 
会 在 厨房 里 ， 你 可 以 密切 注意 冰箱 ) 。 推 理 和 感知 的 
双 癌 集成 目前 已 经 超越 了 最 先进 的 机 器 人 技术 ， 正 在 
成 为 研究 热点 ， 其 灵感 可 能 源 自 认 知 视觉 的 相关 工 
E, 参考 文献 [9.53] 收集 了 这 方面 近年 发 表 的 
论文 。 

为 了 更 全 面 地 了 解 本 章 提 到 的 各 种 方法 及 AI 中 
的 其 余 方法 ， 推 荐 阅读 AI 教材 ， 其 中 由 Russell 和 
Norvig 的 著作 ”1 目前 正 被 广泛 使 用 。 参考 文献 
[9.5] 专门 介绍 了 近年 的 知识 表示 方法 及 相关 问题 ， 
推荐 一 读 。 在 第 一 手 资料 来 源 中 ， 特 别 要 提 一 下 两 部 
BAT, Artificial Intelligence 和 Journal of Artificial Intelli- 
gence Research (JAIR)'*™) ， 其 内 容 均 能 很 好 地 覆盖 
ix OR DT AS Gh BA, International Joint Conferences on 
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本 篇 介绍 机 器 人 结构 ， 主 要 关注 于 机 器 人 的 设 
计 、 建 模 、 动 作 规 划 ， 以 及 对 于 机 器 人 物理 运动 的 控 
制 。 我 们 首先 会 想到 那些 带 有 辟 、 腿 以 及 手 的 机 器 人 
结构 ， 与 此 同时 ， 还 会 想到 轮 式 的 车 辆 和 平台 ， 并 将 
微米 和 纳米 级 的 机 器 人 也 加 入 到 机 器 人 结构 中 。 即 使 
是 对 于 像 手臂 一 样 的 最 简单 的 机 器 人 部 件 ， 考 虑 到 大 
量 的 连 杆 和 传动 机 构 形 式 ， 在 运动 机 构 中 存在 着 各 种 
各 样 的 封闭 运动 链 ， 以 及 关节 连接 的 灵活 性 ， 那 么 让 
人 惊奇 的 形形色色 的 设计 方案 也 是 完全 有 可 能 的 。 对 
于 这 些 结构 的 有 效 模型 和 规划 控制 算法 将 是 更 加 具有 
挑战 性 的 问题 。 

本 篇 的 主题 不 仅仅 对 于 建立 机 器 人 本 身 尤 为 重 
要 ， 对 于 建立 设计 和 控制 动作 ， 按 照 指令 进行 操纵 方 
面 也 至 关 重 要 。 因 此 ， 本 篇 与 机 器 人 学 基础 〈 第 1 
篇 ) 的 联系 是 显然 的 ， 尤 其 是 第 1 篇 中 关于 运动 学 
(第 1 章 )、 动 力学 (第 2 章 ) ， 以 及 机 构 与 驱动 〈 第 
3 章 ) 的 章节 。 将 机 器 人 与 其 他 研究 智能 的 学 科 最 终 
区 别 开 的 因素 就 机 器 人 定义 方面 而 言 ， 是 机 器 人 本 身 
需要 一 种 运动 表现 ; 在 机 器 人 拓展 应 用 方面 ， 是 机 器 
人 需要 与 环境 交互 来 产生 它 的 动作 。 本 篇 所 处 理 的 问 
题 可 以 被 认为 是 组 成 机 器 人 整体 研究 的 一 个 最 基础 
层次 。 

正如 仅仅 通过 简化 后 的 模型 去 了 解 人 类 的 智力 和 
对 人 类 身体 的 远 距 离 探 知 一 样 ， 分 解 开 那 些 结构 的 各 
个 零件 而 不 去 讨论 其 内 部 的 连接 和 相互 影响 是 非常 困 
难 的 。 比 如 说 ， 关 于 怎样 设置 坐标 系 以 及 描述 运动 
(第 3 篇 )， 怎 样 抓 取 和 控制 物体 (第 4 篇 )， 以 及 怎 
样 教会 复杂 的 机 器 人 去 学 习 (第 5 篇) 都 不 可 避免 
的 需要 考虑 到 机 器 人 的 物理 结构 。 专 门 为 多 种 用 途 和 
环境 所 设计 的 机 器 人 (第 6 篇)， 尤其 是 那些 专门 针 
对 直接 与 人 接触 的 那些 机 器 人 (第 7 篇 )， 也 自然 需 
要 考虑 到 机 器 人 的 物理 结构 。 

本 篇 各 章 的 主要 内 容 包 括 : 

第 10 章 性 能 评价 与 设计 标准 ， 提 供 了 一 个 关于 
机 器 人 设计 过 程 的 简洁 概述 ， 以 及 关于 设计 结构 工具 
的 评价 标准 和 机 器 人 运动 表现 的 评价 体系 的 简单 调 
钱 。 例 如 工作 空间 、 局 部 和 全 局 灵活 性 ， 以 及 弹性 静 
力学 和 弹性 动力 学 的 表现 评价 ， 它 们 不 仅 决 定 了 机 器 
人 的 拓扑 结构 以 及 物理 维度 ， 而 且 还 能 对 诸如 工件 放 
置 和 动态 元 余 自 由 度 解决 方案 起 到 一 定 的 作用 。 

第 11 章 运 动 学 宛 余 机 械 臂 ， 处 理 了 宛 余 自由 度 
的 运动 的 产生 和 控制 的 问题 。 运 动 学 的 宛 余 使 机 器 人 
具有 更 高 程度 的 灵活 性 ， 这 样 的 灵活 性 可 以 用 于 避免 
奇异 点 、 关 节 限 制 和 工作 空间 障碍 等 方面 ， 同 时 还 能 
够 最 小 化 驱动 转 矩 、 能 量 以 及 其 他 适应 性 运动 执行 标 


准 。 本 章 主要 对 控制 区 间 的 逆向 运动 宛 余 解决 方案 进 
行 了 讨论 ， 其 中 涉及 了 从 仅 有 少数 运动 元 余 自 由 度 到 
可 以 被 运动 模型 认为 是 连续 曲线 的 大 量 的 宛 余 控 制 
情况 。 

第 12 章 并 联机 器 人 ,介绍 了 仿真 机 械 运 动 学 和 
动力 学 ,例如 著名 的 Stewart- Gough 平台 。 并 联机 构 
包含 闭环 的 运动 结构 ， 还 有 诸如 那些 与 研究 串联 机 构 
相差 很 大 的 研究 方法 。 本 章 主要 讨论 了 多 种 主题 ， 从 
并 联机 构 的 运动 合成 、 正 向 和 逆向 运动 学 ， 到 对 于 其 
特殊 行为 、 工 作 位 置 特性 、 静 态 和 动态 分 析 以 及 实际 
涉及 问题 的 探究 。 

第 13 章 具 有 柔性 元 件 的 机 器 人 ， 讨 论 了 动态 模 
型 和 对 于 由 柔性 关节 和 连 杆 组 成 的 机 器 人 的 控制 。 因 
为 对 于 柔性 关节 和 和 柔性 连 杆 ， 两 者 研究 方法 在 结构 上 
是 不 同 的 ， 所 以 这 一 章 主要 建立 在 这 两 种 柔性 模式 的 
相互 独立 研究 基础 上 。 这 种 方法 可 以 扩展 到 关节 和 连 
杆 都 具有 和 柔性 的 机 器 人 中 ， 甚 至 是 两 者 同时 在 相互 动 
态 影响 的 实例 中 。 本 章 中 还 给 出 了 工业 机 器 人 中 柔性 
的 典型 来 源 。 

第 14 章 模型 识别 ， 讨 论 了 确定 机 器 人 控制 系统 
的 动态 内 部 参数 设 定 的 方法 。 对 于 动态 的 测量 ， 首 要 
目的 是 确定 几何 的 D-H 参数 或 者 运动 学 方程 ， 主 要 


尺 一 方面 的 内 部 参数 是 通过 在 执行 一 段 轨迹 过 程 中 测 
量 一 个 或 多 个 关节 的 力 和 力矩 的 方式 进行 分 析 的 。 这 
样 的 动态 和 内 部 参数 定义 可 以 被 转换 为 对 于 常规 结构 
的 最 小 二 乘法 分 析 ， 也 就 是 说 常规 结构 的 关于 定义 的 
参数 、 测 量 方式 的 充分 性 ， 以 及 数值 鲁 棒 性 都 是 由 动 
态 和 内 部 参数 所 确定 和 影响 的 。 本 章 将 就 这 些 问 题 展 
开 讨论 。 

第 15 章 机 器 人 手 ， 介 绍 机 器 人 手 设计 、 建 模 和 
控制 背后 所 涉及 的 主要 原理 问题 。 从 讨论 拟人 化 程度 
和 机 械 手 灵巧 性 特点 开始 ， 本 章 分 析 了 机 器 人 手相 关 
设计 问题 、 驱 动 、 传 动 架构 ， 以 及 可 行 的 传 感 技术 
等 。 机 器 人 手 控 制 和 动态 建 模 之 所 以 困难 ， 不 仅仅 是 
因为 复杂 的 运动 学 结构 ， 还 有 那些 柔性 传动 元 件 。 本 
章 对 这 些 问 题 也 作 了 专门 的 介绍 。 

第 16 章 有 腿 机 器 人 ， 主 要 讨论 了 关于 设计 、 分 
析 、 控 制 有 腿 机 器 人 方面 的 大 量 问题 。 以 有 腿 机 器 人 
发 展 的 历史 作为 开端 ， 本 章 提 供 了 回转 行走 分 析 ， 以 
及 建立 在 前 进 动力 和 ZMP (FHR) 基础 上 的 双 
足 机 器 人 的 控制 。 与 此 同时 ， 例 如 模拟 哺乳 动物 的 四 
足 机 器 人 这 样 的 多 足 机 器 人 也 在 本 章 中 进行 了 讨论 。 
更 进一步 ， 混 合 的 由 腿 、 手 和 轮 式 结构 共同 组 成 的 机 
器 人 、 绳 索 行 走 机 器 人 ， 甚 至 是 能 够 攀 | 民 墙壁 的 有 腿 
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第 17 章 轮 式 机 器 人 ， 提 供 了 一 个 关于 轮 式 机 器 
人 普遍 且 便 于 理解 的 描述 。 这 一 章 首先 讨论 了 基于 轮 
式 结构 的 机 器 人 的 运动 性 ， 以 及 其 运动 约束 的 特性 。 
本 章 还 论述 了 运动 和 动力 状态 的 空间 模型 ， 以 及 轮 式 
机 器 人 的 结构 特点 。 这 些 特点 主要 包括 : 控制 能 力 、 
非 完整 性 以 及 稳定 性 。 本 章 还 讨论 了 在 非 线性 控制 中 
的 反馈 线性 化 ， 以 及 基于 车 轮 个 数 和 形式 的 不 同 的 机 
虎 人 结构 分 类 等 方面 的 问题 。 

第 18 章 微型 和 纳米 机 器 人 ， 提 供 了 一 个 关于 当 


前 微型 和 纳米 机 器 人 的 现状 的 概述 。 前 一 部 分 具体 描 
述 了 在 训 米 和 微米 级 别 的 机 器 人 对 于 物体 的 控制 ， 以 
及 在 这 一 个 太 度 空间 内 对 于 自主 机 器 人 结构 的 设计 和 
实现 〈 纳 米 机 器 人 也 是 应 用 同样 的 定义 ， 只 是 其 尺 
寸 维 度 被 限制 在 纳米 的 程度 以 内 )。 概 述 了 尺度 效 
应 、 驱 动 ， 以 及 在 此 尺寸 级 别 内 的 传 感 和 制造 问题 。 
同时 ， 还 论述 了 微型 结构 、 生 物 科学 以 及 对 于 微米 和 
纳米 级 的 电子 机 械 系统 的 制造 和 特性 在 现实 中 的 应 用 
间 题 。 
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本 章 主要 介绍 机 器 人 的 设计 ， 重 点 是 串联 结构 
机 器 人 。 在 开始 部 分 提出 一 个 分 阶段 的 设计 流程 ， 
然后 介绍 机 器 人 设计 中 需 考虑 的 主要 因素 ， 包 括 工 
作 空 间 几 何 特性 、 动 态 静 力学 、 动 力学 、 静 弹性 和 
动弹 性 指标 。 为 此 ， 这 些 概念 所 需 的 数学 知识 也 被 
简要 地 介绍 以 使 本 章 更 易 理解 。 

我 们 总 结 部 分 在 机 器 人 机 械 设计 和 性 能 评价 中 
用 到 的 工具 和 指标 。 重 点 关注 主要 用 于 操作 任务 的 
机 器 人 和 串联 链 结构 。 并 联机 器 人 的 运动 学 在 第 
12 章 中 介绍 ， 轮 式 、 行 走 机 器 人 、 多 指 手 和 其 他 
特殊 结构 在 各 自 相 应 的 章 中 介绍 。 
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本 音 介 绍 的 指标 和 工具 的 最 主要 用 途 是 机 器 人 
的 机 械 结构 设计 。 机 器 人 设计 和 普通 的 单 自 由 度 机 
构 设 计 的 差别 在 于 ， 后 者 只 完成 一 个 特定 的 任务 ， 
如 从 传送 带 上 拾 起 一 个 工件 并 把 它 放 到 托盘 上 ， 传 
送 带 是 与 机 构 同 步 的 ， 托 盘 是 静止 的 ， 工 件 应 放 到 
何 处 已 经 被 明确 定义 。 与 此 不 同 ， 机械手 不 只 完成 
一 个 特定 的 任务 ， 而 是 一 类 任务 ， 可 能 是 平面 、 球 
面 、 直 线 ， 或 如 选择 柔性 装配 机 械 臂 (SCARA) 能 
够 完成 的 动作 ， 也 被 称 为 Schinflies 位 移 、，” 等 。 机 
器 人 设计 者 面临 的 挑战 是 机 器 人 将 执行 的 任务 的 不 
确定 性 。 设 计 标 准将 有 助 于 设计 者 处 理 这 些 不 确 
定性 。 


10.1 机 兹 人 设计 流程 


给 定 一 系列 的 任务 ， 如 功能 要 求 和 更 具体 的 设计 
POR, 设计 者 需要 设计 一 台 机 占 人 满足 上 述 所 有 要 
求 。 设 计 过 程 包括 以 下 阶段 : 

1) 确定 机 械 结 构 对 应 的 运动 链 的 拓扑 结构 。 我 
们 将 机 器 人 分 为 三 类 : 串联 、 并 联 和 混合 络 构 。 然 后 
确定 各 子 链 间 的 关节 连接 形式 ， 最 常用 的 是 转动 式 和 
棱柱 式 。 近 年 来 ， 一 种 新 的 形式 也 被 广泛 使 用 ， 
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M-T, WSO ane HA, Fe 
耦合 的 两 杆 实现 平移 ， 这 四 个 杆 构成 了 一 个 平行 四 边 
形 结构 7。 

2) 确定 各 杆 件 的 几何 尺寸 以 定义 机 器 人 结构 ， 
即 填写 Denavit- Hatenberg 参数 表 [0031 来 满足 工作 空间 
要 求 。 尽 管 通常 关节 变量 也 被 包含 在 上 述 参数 中 ,但 
关节 变量 并 不 影响 机 器 人 结构 ， 而 是 确定 机 器 人 
姿态 。 

3) 确定 各 杆 件 和 关节 的 结构 参数 以 满足 静态 负 
载 要 求 ， 负 载 包 括 力 和 力矩 。 要 求 即 可 以 定义 为 最 大 
负载 情况 ， 也 可 以 定义 为 最 常见 工作 状态 ， 这 取决 于 
所 采用 的 设计 思路 。 

4) 确定 各 枉 件 和 关节 的 结构 参数 来 满足 动态 
负载 要 求 ， 负 载 包括 杆 件 和 操作 对 象 共同 的 惯性 
效应 。 

5) 确定 整体 机 械 结构 的 动弹 性 参数 ， 包 括 执行 
器 的 动态 特性 ， 以 避免 最 大 负载 条 件 或 最 常见 工作 条 
件 下 的 特定 共振 频率 。 

6) 针对 设计 中 确定 的 工作 条 件 选择 执行 器 和 相 
应 的 机 械 传 动 形式 ， 来 适应 任务 的 不 确定 性 。 

上 述 过 程 应 依次 执行 : @@ 首 先 ， 基 于 任务 系列 和 
工作 空间 的 形状 (IL 10.2.2 节 ) 确定 拓扑 结构 。 
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(基于 对 工作 空间 的 要 求 ， 包 括 最 大 可 达 位 置 和 前 一 
阶段 定义 的 拓扑 结构 ， 确 定 杆 件 的 几何 尺寸 。 轩 基于 
上 述 杆 件 几何 斥 寸 确定 各 杆 件 和 关节 的 结构 参数 以 达 
到 满足 支撑 静态 负载 要 求 〈 除 并 联机 器 人 外 ， 其 他 
类 型 机 器 人 的 所 有 关节 都 是 主动 驱动 的 ， 并 联机 器 人 
不 在 本 章 的 讨论 范围 内 ) 。@ 旨 基于 上 上述 由 静态 负载 条 
件 确 定 的 杆 件 和 关节 结构 参数 ， 确 定 杆 件 的 质心 和 转 
动 惯 量 和 矩阵 来 初步 评价 电动 机 力矩 需求 (这 种 评价 
是 初步 的 ， 因 为 执行 紫 的 动态 特性 没有 被 考虑 ， 这 种 
负载 变化 是 显著 的 ， 即 使 对 所 有 执行 器 都 安装 在 机 座 
上 的 并 联机 器 人 )。@@ 假 设 杆 件 是 刚性 的 ， 关 节 具 有 
和 柔性， 根据 经 验 或 由 类 似 的 机 器 人 得 到 的 数据 ， 可 以 
得 到 机 器 人 的 动弹 性 模型 ， 其 在 一 系列 选择 的 姿态 下 
的 自然 模 态 和 频率 (结构 的 动态 行为 受 机 器 人 姿态 
影响 ) 可 以 由 科学 编程 语言 如 Matlab 或 计算 机 辅助 
工程 (CAE) 语言 如 Pro/Engineer 或 ANSYS 获得 。 
@@ 如 果 机 器 人 结构 的 频率 谱 可 以 被 接受 ,设计 者 可 以 
开始 选择 电动 机 ， 否 则 需要 重新 进行 参数 选择 ， 即 返 
回 步骤 3)。 

尽管 一 个 设计 周期 可 以 按 上 述 过 程 完成 ， 设 计 者 
现在 必须 协调 动弹 性 模型 和 电动 机 制造 商 提 供 的 结构 
和 惯量 数据 。 这 要 求 返 回 阶 段 5) 并 进行 新 一 轮 的 动 
弹性 分 析 。 显 然 ， 机 器 人 设计 过 程 和 普遍 的 工程 设计 
过 程 有 一 个 共同 点 : 它们 都 是 迭代 进行 的 ”"“。 值 得 
注意 的 是 ， 不 同 的 设计 阶段 中 有 不 同 的 主导 因素 ， 在 
很 大 程度 上 ， 这 些 因素 是 相互 独立 的 。 例 如 ， 拓 扑 结 
构 和 几何 特性 可 以 独立 于 电动 机 选择 。 当 然 ， 所 有 的 
因素 都 在 整体 设计 过 程 中 相互 影响 ， 但 在 相当 多 的 设 
计 实 例 中 ,不 同 的 因素 并 不 相互 影响 ， 因 此 不 必须 采 
用 多 目标 设计 方法 。 换 言 之 ， 串 联机 器 人 的 最 优 设计 
可 以 通过 一 系列 的 单 目标 最 优 设 计 来 实现 。 表 次 重 
申 ， 最 后 的 结果 ， 电 动机 的 选择 ， 必 须 被 集成 到 整体 
数学 模型 中 以 验证 整体 的 性 能 。 一 个 工业 机 伦 人 的 最 
优 设计 的 范例 见 参考 文献 [10.5]. 

只 有 当 部 件 的 物理 极限 被 突破 的 时 候 才 需要 退回 
阶段 1 进行 彻底 的 重 设 计 。SCARA 系统 就 是 这 种 情 
况 。 当 前 丁 业 机 占 人 大 多 采用 串联 的 拓扑 结构 ， 除 了 
少量 例外 ， 如 Konig & Hartman RP- AH 系列 并 联结 构 
HLAO, HANE RER SCARA 系统 共用 一 个 
末端 执行 器 。 对 更 短 的 往复 运动 时 间 (如 工业 测试 
周期 ， 见 10. 2. 1 节 ) 的 需求 ， 促 使 工业 界 寻求 新 的 
结构 形式 。 现 在 ABB 机 器 人 公司 在 市 场 上 推出 并 联 
机 器 人 FlexPicker， 基 于 Clavel’*s Delta 机 4 Alen 
在 前 三 个 自由 度 之 外 串联 添加 了 第 四 个 自由 度 。 
FlexPicker 整体 采用 并 联结 构 保 证 Delta 机 器 人 的 运动 





台 能 够 进行 纯 平 动 。Adept 技术 公司 报告 的 最 短 往 
复 运 动 周期 是 420ms, 负载 为 2kg (以 Adept Cobra 
s600 串联 机 器 人 实现 ) ， 其 他 制造 商 还 报告 过 更 短 的 
时 间 。 

本 章 按照 上 述 机 器 人 设计 过 程 的 不 同 阶段 的 次 
序 安排 。 注 意 到 拓扑 结构 和 几何 尺寸 的 选择 在 运动 
学 设计 过 程 中 紧密 相关 ， 我 们 以 测试 工作 空间 要 求 _ 
开始 : 回顾 确定 运动 链 拓扑 结构 的 方法 ， 以 及 为 满 
足 工作 空间 要 求 的 几何 尺寸 。 然 后 详细 回顾 为 评价 
机 器 人 的 操作 能 力 而 提出 的 各 种 标准 ， 重 点 是 基于 
运动 学 和 动力 学 模型 的 关于 灵活 性 的 定量 描述 。 随 
后 检验 为 满足 静态 和 动态 负载 要 求 确 定 杆 件 和 关节 
结构 参数 的 方法 。 最 后 讨论 动弹 性 特征 ， 执 行 器 和 
齿轮 的 尺寸 ， 其 中 考虑 到 机 器 人 的 固有 频率 特性 ， 
力 和 加 速度 要 求 。 


10.2 工作 空间 标准 


机 器 人 的 设计 过 程 中 一 个 首要 的 考虑 是 它 的 工作 
空间 需要 满足 一 系列 特性 要 求 ， 随 之 而 来 的 问题 是 用 
户 如 何 指 定 这 些 特性 。 

上 述 因素 基本 可 以 归于 Vijaykumar 等 人 提出 的 机 
械 手 区 域 结构 。 将 机 械 手 视 为 解 耦 的 结构 ， 最 后 
三 个 转动 关节 的 轴线 交 于 一 点 ， 构 成 一 个 球形 脑 ， 轴 
的 交点 被 称 为 腕 中 心 。 对 于 这 种 结构 的 机 械 手 ， 一 个 
操作 任务 可 以 被 分 解 为 位 置 和 姿态 子 任务 : 由 前 3 个 
关节 构成 的 机 器 人 的 区 域 结构 负责 将 胸中 心 放 管 到 指 
定点 C(x, y, z); 随后 ， 局 部 结构 ， 即 腕 部 ， 保 证 
末端 操作 手 (EE) 获得 相对 机 座 坐 标 系 用 一 旋转 矩 
阵 描述 的 指定 姿态 。 

文献 中 大 部 分 确定 工作 空间 的 算法 都 采用 区 域 
结构 。 在 此 ， 我 们 需要 指出 不 考虑 物理 可 实现 性 的 
运动 链 的 工作 空间 和 实际 机 器 人 的 工作 空间 之 间 的 
区 别 。 对 于 前 者 ， 所 有 的 转动 关节 都 可 以 不 受 限 制 
地 绕 其 轴线 转动 ; 对 于 后 者 ， 关 节 限 制 是 存在 的 ， 
如 为 防止 导线 缠绕 。 在 机 器 人 设计 的 前 期 ， 可 以 暂 
不 考虑 关节 限制 ， 工 作 空 间 的 对 称 性 由 关节 类 型 
决定 。 如 果 第 一 个 关节 是 转动 关节 ， 整 个 工作 空 
间 绕 该 关节 的 轴线 对 称 ; 如 有 果 第 一 个 着 是 校 柱 
KD, CHES ARA RENT E, RE OF Td H 
该 关节 的 运动 方向 决定 。 理 论 上 棱柱 关节 可 以 无 
限 延 伸 ， 具 有 棱柱 关节 的 机 器 人 的 工作 空间 也 是 
无 限 延 伸 的 。 实 际 中 机 器 人 的 工作 空间 是 其 一 个 


对 于 并 联机 器 人 (将 在 14 HARE), 总 体 


186 第 2 篇 ”机 器 人 结构 





上 ， 区 域 结 构 的 意义 不 那么 清晰 。 显 示 其 工作 空间 的 
一 个 常用 方法 是 保持 其 运动 平台 〈 相 当 于 串联 机 器 
人 的 末端 操作 手 ) 在 一 个 固定 的 姿态 "”。 在 设计 阶 
段 ， 并 联机 需 人 结构 常 采用 的 一 个 共同 特性 是 ， 用 相 
同 结构 且 对 称 放 息 的 腿 联 结 机 座 和 动 平 台 。 每 条 腿 是 
具有 一 或 两 个 主动 自由 度 的 串联 运动 链 ， 其 余 的 自由 
度 均 为 被 动 自由 度 。 这 类 机 器 人 的 工作 空间 也 具有 对 
称 性 ， 但 不 是 轴 对 称 。 对 称 性 由 腿 的 数目 和 驱动 关节 
的 类 型 确定 。 

回 到 串联 机 器 人 的 情况 ， 工 作 空 间 可 以 被 定义 为 
下 列 两 种 情况 之 一 ， 除 了 在 一 些 Lebesgue 测量 值 为 
RU 中 的 点 处 ， 几 乎 处 处 连续 的 拓扑 空间 簇 或 表面 。 
一 般 地 说 ， 在 表面 上 这 样 的 点 构成 一 条 曲线 ,例如 球 
面 上 的 子午 线 ， 或 直线 上 一 些 孤 立 点 构成 一 个 集合 ， 
例如 实 轴 上 的 有 理 数 。 一 个 表面 型 工作 空间 的 例子 是 
Puma HLA, È RZ DSR 10. 1 所 示 。 在 图 中 ， 
区 域 和 局 部 结构 可 以 被 很 容易 地 分 辨 ， 前 者 处 于 完全 
展开 状态 。 机 器 人 的 工作 空间 可 以 按 下 列 步 骤 获 得 : 
首先 ， 当 机 器 人 处 于 图 10. 1 所 示 的 姿态 时 ， 锁 定 除 
关节 2 以 外 所 有 关节 ， 然 后 令 关节 2 绕 其 轴线 充分 旋 
转 ， 腕 的 中 心 C 构成 一 个 半径 为 尺 的 圆周 ， 也 就 是 C 
和 直线 L 之 间 的 距离 。 圆 周 所 在 的 平面 垂直 于 直线 
L, SRP) 的 轴线 L 之 间 的 距离 是 六， 这 个 距离 
也 被 称 为 肩 部 偏 移 。 现 在 锁定 除 关 节 1 以 外 所 有 关 
节 ， 然 后 机 器 人 绕 轴 线 L 转动 ， 结 果 如 图 10. 2 中 的 
环形 。 这 个 表面 包围 的 内 部 就 是 布尔 操作 和 CC 的 结 
果 ， 其 中 8# 是 中 心 在 0, 半径 为 R 的 球体 ， 见 图 10.1, 
C 是 半径 为 b, 轴线 为 Z 的 无 限 圆 柱 体 。 需 要 指出 的 
是 ， 尽 管 这 个 工作 空间 可 以 用 简单 的 布尔 操作 产生 ， 
却 不 能 由 形 如 f(x，y，z) =0 WARRE, HAK 
面 不 是 一 个 拓扑 空间 艇 。 





图 10. 1 一 台 处 于 完全 展开 姿态 的 Puma 
机 器 人 ( 引 自 参考 文献 [10.11] ) 


具有 拓扑 空间 复工 作 空 间 的 工业 机 器 人 并 不 党 
见 。 图 10. 3 所 示 是 一 个 满足 区 域 结 构 的 六 轴 解 耦 机 








图 10. 2a-c Puma 机 器 人 的 工作 空间 
( 引 自 参考 文献 [10.11] ) 


器 人 ， 它 的 相 邻 轴线 相互 垂直 ， 之 间 的 距离 都 是 a。 
两 轴 的 公法 线 与 两 轴 的 交点 之 间 的 距离 也 是 a， 如 
X, 和 XX， Xa MX, 以 及 C 和 Zs 之 间 的 距离 也 是 一 
样 。 点 C 是 球形 腕 的 中 心 ， 腕 结构 没有 在 图 中 显 
示 。 机 器 人 的 工作 空间 可 以 用 f(x,，y, z) =0 形式 
的 函数 表示 "” ， 对 应 图 10.4 所 示 的 拓扑 空间 簇 。 
图 中 工作 空间 内 部 的 深 色 区 域 对 应 在 该 处 道 运动 学 
存在 四 个 实数 解 的 所 有 点 的 集合 ， 其 他 点 处 只 存在 
两 个 解 。 





图 10.3 一 台 包 括 三 个 正 交 的 转动 关节 的 机 器 人 
( 引 自 参考 文献 [10.11] ) 


工作 空间 边界 上 的 任意 点 意味 着 位 置 奇异 ， 与 姿 
ASAT RAN TE), TEZA Shs Dd La A Ze 
作 空 间 边界 上 的 楼 线 处 表现 出 两 种 奇异 ， 除 位 置 奇异 
外 还 包括 姿态 奇异 。 在 棱 线 处 雅 可 比 矩 阵 的 秩 减 少 
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区 域 ” 解 的 数量 





z Yı 
图 10.4 图 10.83 中 的 正 交 机 器 人 的 工作 空间 
( 引 自 参考 文献 [10.11] ) 


2， 在 边界 上 的 其 他 点 处 秩 减 少 1。 

现在 可 以 概括 出 基于 工作 空间 形状 的 设计 准则 : 

1) 如 果 要 求 工 作 空 间 是 轴 对 称 的 ， 且 容积 有 
限 ， 选 用 具有 区 域 结构 的 串联 构 型 ， 且 只 选用 转动 
关节 。 

2) 如 果 要 求 工作 空间 是 棱柱 形 且 容积 无 限 ， 选 
用 具有 区 域 结 梅 的 串联 构 型 ， 第 一 个 关节 选用 棱柱 关 
节 。 在 此 ， 无 限 的 真正 意义 是 沿 某 一 方向 远 远 大 于 其 
他 方向 。 另 外 ， 如 果 要 求 只 沿 一 个 方向 远 远 大 于 其 他 
方向 ， 可 棱柱 关节 即 可 以 选用 地 面 上 的 轨道 ， 也 可 以 
选用 空中 的 悬 架 。 如 果 要 求 没 两 个 方向 远 远 大 于 其 他 
方向 ， 则 选用 轮 式 移动 机 器 人 携带 机 械 手 ， 最 著名 的 
例子 是 美国 航空 航天 局 在 1997 年 寻找 到 火星 路 线 计 
划 中 采用 的 Sojourner, 

3) 如 果 不 要 求 工 作 空间 具有 轴 对 称 结构 ， 但 要 
求 若干 共 面 的 对 称 轴 ， 类 似 于 正 多 边 形 结构 ， 选 用 并 
联机 器 人 。 


10.2.1 到 达 一 系列 目标 坐标 系 


与 工作 空间 要 求 密 切 相 关 的 一 个 问题 是 任务 要 
求 。 在 机 械 设计 中 的 一 个 常用 做 法 是 在 空间 中 指定 一 
系列 坐标 系 ， 然 是 设计 一 个 能 够 到 达 所 有 这 些 坐 标 系 
的 符合 预 设 拓扑 结构 的 机 构 。 到 达 各 坐标 系 的 次 序 必 
须 被 指定 。 如 果 不 是 所 有 的 坐标 系 都 能 被 到 达 ， 那 么 
寻求 一 个 能 够 在 某 种 意义 上 最 接近 这 些 坐 标 系 的 机 
构 。 关 于 这 个 经 典 机 构 设计 问题 的 文献 有 许多 ， 可 以 
参考 文献 [10.1, 12, 13] 及 其 引用 的 参考 文献 。 
在 此 指出 应 用 这 种 目标 坐标 系 方法 设计 机 器 人 时 需 注 
BJL: 

1) 并 不 总 需要 精确 地 达到 期 望 的 坐标 系 ， 有 时 
候 甚至 是 不 可 能 的 : 某 些 情况 下 更 好 的 选择 是 采用 东 
种 优化 方法 获得 到 达 期 望 位 姿 的 最 小 误差 〈 保 证 误 
差 的 模 满 足 工 程 要 求 ) 。 


2) 参考 文献 [10.9] 中 指出 , 通过 区 间 分 析 ， 
考虑 到 制造 误差 因素 ,不仅 是 一 系列 离散 的 姿态 ， 而 
是 整个 六 维 工 作 空间 都 可 以 到 达 。 

3) 单 自 由 度 结构 设计 中 的 分 支 问 题 在 机 器 人 设 
计 中 也 有 可 能 出 现 : 基于 通过 点 的 设计 结果 可 以 到 达 
所 有 的 期 望 位 姿 ， 但 有 可 能 不 能 在 一 个 特定 的 运动 模 
式 中 实现 所 有 的 位 姿 。 这 个 问题 在 机 器 人 设计 中 变 得 
更 为 明显 ， 给 定 一 个 末 段 操作 手 的 姿态 ， 转 动 解 耦 的 
六 自由 度 串 联机 器 人 可 以 产生 最 多 16 个 可 能 解 ， 即 
16 A Ay 0 14,15] ‘ 

4) 为 机 器 人 提出 设计 任务 ， 即 要 求 其 末端 操作 
手 能 够 到 达 一 系列 位 姿 时 ， 不 应 忘记 使 用 机 器 人 的 目 
的 不 是 完成 一 个 特定 的 任务 ， 而 是 一 系列 任务 。 选 择 
的 目标 姿态 应 该 能 够 反映 这 些 任务 。 

结合 上 述 各 点 ， 我 们 可 以 介绍 SCARA 系统 的 设 
计 或 评价 过 程 。SCARA 系统 是 一 个 四 自由 度 的 串联 
机 器 人 ， 可 以 在 通用 刚体 位 移 集合 的 Schonflies 子 集 
内 完成 若干 任务 “1 ， 也 就 是 除 三 维 的 平移 运动 
外 增加 一 个 绕 固 定 轴 的 转动 。 在 这 类 系统 中 ， 手 部 的 
任务 是 一 段 长 300mm 的 水 平 线 段 联结 的 两 段 长 23mm 
的 垂直 线段 。 未 端 操作 手 可 以 垂直 运动 ， 同 时 绕 垂 直 
轴 在 180° 范围 内 转动 。SCARA 制造 商 采 用 的 任务 规 
范 中 没有 说 明 如 何 处 理 角落 的 问题 ， 这 个 问题 留 给 机 
ar AL FAN A ACE. 


10.2.2 工作 空间 容积 和 拓扑 结构 


1. 可 达 和 灵活 工作 空间 

A Roth 的 早期 工作 “ ”开始 ， 关 于 机 械 手 运动 
学 几何 特性 和 其 工作 空间 之 闻 的 关系 已 经 进行 了 许多 
研究 。 大 部 分 研究 中 都 将 工作 空间 分 为 两 部 分 : 可 达 
空间 和 灵活 空间 “” 。 为 末端 操作 手指 定 一 个 参考 
点 P， 例 如 球形 腕 的 中 心 或 末端 操作 手 上 的 其 他 点 ， 
可 达 空 间 被 定义 为 P 点 在 物理 上 可 到 达 的 空间 点 的 集 
合 。 灵 活 空间 被 定义 为 P 点 可 以 以 任意 末端 操作 手 姿 
态 到 达 的 点 的 集合 。 

关于 工作 空间 的 早期 文献 主要 集中 于 用 数值 或 代 
数 方法 描述 工作 空间 。 可 达 空 间 和 灵活 空间 被 分 别 被 
Kumar 和 Walron!'® 2 , Yang 和 Lee! !*9! 以 及 Tsai 和 
Soni! 7!) Fi] FT PRUETT FDOT. ROT A 
比 ， 这 种 方法 的 主要 优点 是 可 以 方便 地 引 人 运 动 约 
束 。 但 应 用 这 种 方法 却 难以 获得 通用 的 设计 准则 。 在 
表征 工作 空间 的 代数 方法 中 ，Gupta 和 Roth 以 及 
Guptal 2 中 采用 了 拓扑 分 析 方 法 ， 并 提出 了 工作 空 
闻 中 的 孔 和 空洞 的 概念 ， 并 验证 了 其 存在 条 件 。 可 达 
空间 和 灵活 空间 的 形状 也 被 表述 为 P 的 函数 。 
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Lini ”进行 了 更 
深入 的 研究 ， 建 立 了 运动 学 参数 和 工作 空间 之 间 的 精 
确 关 系 ， 并 对 一 类 三 关节 机 械 手 针对 工作 空间 的 容积 
进行 了 优化 。Vijaykumar 等 人 对 工作 空间 优化 进行 了 
蝎 通 用 的 分 析 。 根 据 灵活 空间 定义 了 机 械 手 的 性 能 指 
标 ， 即 给 出 一 个 机 械 手 满足 若干 关于 其 Denavit- 
Hartenberg 参数 的 约束 条 件 ， 结 果 显 示 最 优 的 6R 设 
计 是 肘 式 机 械 手 形式 。 

机 器 人 区 域 结构 的 一 种 典型 设计 是 正 交 形式 ， 锯 
括 一 个 沿 垂直 轴 转 动 的 关节 和 两 个 沿 水 平 轴 转 动 的 关 
五 ， 其 中 一 条 水 平 轴 与 垂直 轴 相 交 。 常 用 的 结构 还 包 
括 长 度 相 等 的 中 间 和 远 端 杆 件 。 这 种 结构 的 工作 空间 
是 一 个 半径 为 两 倍 上 述 长 度 的 球体 。 其 容积 自然 由 该 
长 度 决定 。 如 参考 文献 Yoshikawa [10.26] 中 指出 
的 ， 由 上 述 区 域 结构 的 最 后 两 个 杆 件 构成 的 平面 两 连 
杆 机 械 手 的 工作 空间 是 所 有 具有 同样 杆 件 长 度 的 结构 
中 最 大 的 。 上 共有 同样 区 域 机 构 的 机 械 手 的 工作 空间 也 
几乎 是 在 同类 机 器 人 中 最 大 的 。 

2. 微分 几何 工作 空间 表征 

如 果 将 机 器 人 末端 操作 手 的 配置 空间 视 为 一 个 
特定 的 欧 几 里 德 集合 SE (3) WEE, 工作 空间 也 
可 以 通过 微分 几何 方法 求解 。 在 定义 空间 机 构 的 工 
作 空 间 容积 时 需要 考虑 的 一 个 重要 原则 是 其 应 不 受 
选择 的 参考 坐标 系 的 影响 。 这 个 要 求 的 一 个 不 很 吉 
观 的 表述 形式 是 ， 容积 不 应 受 末 端 操 作 手 坐标 系 被 
定义 在 最 后 一 个 杆 件 上 的 哪 一 点 的 影响 。 这 个 条 件 
有 下 述 物理 意义 : 无 论 操 作 手 变 大 或 变 小 ， 机 器 人 
部 应 拥有 同样 的 工作 空间 容积 ， 其 只 取决 于 关节 轴 
线 位 置 。 

如 将 SE (3) 视 为 一 个 Riemanian i Fh 2s Eg, 
则 工作 空间 的 容积 就 是 SE (3) 的 容积 经 运动 学 映射 
f 得 到 的 像 的 容积 。SE (3) 有 一 个 双重 不 变 特性 ， 
即 其 容积 既 不 受 静 坐标 系 (机 座 坐 标 系 )， 又 不 受 动 


Freudenstein 和 PromroseLl0 “4! 





坐标 系 REEF ARR) 的 选择 的 影响 ， 见 参 


考 文献 Loncaric [10.27], Peden 和 Sastry 在 参考 文 
献 [10.28] 中 给 出 了 一 个 直观 的 例子 。 假 设 一 架 飞 
机 被 限制 在 一 个 边 长 Ikm 的 空间 立方 体内 飞行 ,在 
这 个 范围 的 任意 一 点 ， 飞 机 可 以 将 其 自身 指向 4m 的 
固态 角 范 围 内 的 任意 一 个 方向 ， 并 可 绕 其 指向 的 方向 
在 2 角度 范围 内 横 滚 ， 在 每 一 点 处 飞机 的 姿态 容积 
是 4m x2m =8m rad ， 乘 以 位 置 容 积 得 到 飞机 在 自由 
配置 空间 内 的 容积 是 8mrad kw, 

工作 空间 的 这 种 描述 方式 在 机 器 人 学 中 得 到 广 
泛 应 用 ， 主 要 优点 是 不 同 于 灵活 空间 的 常规 定义 ， 
这 种 方式 可 以 协调 处 理 位 置 自由 度 和 姿态 自由 度 。 





需要 指出 ， 得 到 的 实际 数值 受 对 物理 空间 采用 的 长 
度 比例 的 影响 ;这 点 对 工作 空间 容积 本 身 不 是 个 严 
车 的 问题 ， 比较 不 同 工 作 空间 时 如 果 采 用 相同 的 长 
度 比 例 也 不 是 问题 。 

在 参考 文献 【10. 28 ] 中 ，Paden 和 Sastry 采用 
上 上述 几何 架构 证 明 满足 运动 学 长 度 约束 ， 拥 有 最 大 
工作 空间 的 OR 机 械 手 是 肝 式 机 械 手 ， 这 与 Vijayku- 
mar FA Ay A BH ae SO 8) eh 获得 结果 过 
程 中 ， 没 有 采用 Vijaykumar 所 做 的 关于 运动 学 结构 
的 假设 。 


10.3 灵巧 性 指标 


10.3.1 开 链 结构 的 局 部 灵巧 性 


灵巧 性 可 以 被 定义 为 沿 任 意 方向 同样 容易 地 运动 
并 施加 力 和 力矩 的 能 力 ， 这 个 概念 属于 动态 静 力 学 的 
范畴 ， 即 研究 多 肢体 机 械 系统 中 静态 保守 条 件 下 ， 可 
行 复合 速度 和 约 东 复合 力 之 间 的 相互 作用 关系 。 这 
里 ， 复 合 速度 是 一 个 六 维 的 刚体 速度 矢量 ， 包 括 参 考 
点 的 3 个 速度 分 量 和 刚体 整体 的 3 个 角速度 分 量 。 复 
合力 是 作用 在 刚体 上 的 一 个 六 维 静态 矢量 ， 和 包括 作用 
在 参考 点 的 合力 的 3 个 分 量 和 作用 在 物体 上 的 伴随 力 
ABE 3 个 分 量 。 

Salisbury 和 Craig 31 介绍 了 关节 手臂 设计 过 
程 中 的 灵巧 性 概念 ， 将 其 视 为 由 输入 关节 速度 误 
差 到 指 尖 处 的 输出 速度 之 间 的 传递 关系 。 为 说 明 
这 一 概念 ， 用 J(6) 代表 正 运 动 学 映射 的 雅 可 比 矩 
阵 ， 即 


t=J(0)0 (10. 1) 


式 中 , 9 和 8 分 别 代表 关节 变量 和 关节 速度 矢量 ， 
t 是 末端 操作 手 的 复合 速度 ， 被 定义 为 


ay 
‘|( 
APF, o 代表 末端 操作 手 的 角速度 ，p 是 未 端 操作 手 


的 操作 点 的 速度 ， 即 定义 任务 时 的 参考 点 。 
LA n A m 分别 代表 关节 空间 8# 和 末端 操作 手 配 置 


空间 9 的 维 数 ， 总 有 n 宇 m。 单 位 球面 19 | lle =1| 
经 过 映射 J(8) 的 像 是 复合 速度 空间 上 内 的 一 个 椭 球 
面 。 事 实 上 ， 即 使 我 们 假定 n = m 得 出 的 结论 ， 也 能 
适应 更 通用 的 情况 nm。 我 们 在 此 保留 完整 的 假设 
是 为 了 以 后 讨论 的 简化 。 对 了 进行 极 值 分 解 0020] 
得 到 ; 








(10.2) 


J =RU =VR (10.3) 
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式 中 ，R 是 一 个 正 交 和 矩阵 ， 既 可 以 是 有 理 的 ， 也 可 
以 是 无 理 的 。 有 理 情况 下 ,，R 代表 旋转 ， 无 理 情况 
下 ,，R 代表 反射 。U 和 VV 是 对 称 ， 至 少 为 半 正 定 阵 。 
如 果 JAIE, M UA VAERE, HERS 
解 方式 唯一 。 这 两 个 矩阵 总 可 以 通过 相似 变换 联系 
在 一 起 

V = RUR" (10.4) 
LE Pe A I SE SRP E 
特征 值 同 时 也 是 J aT A. URH {Re U WX 
角 表 述 形式 ， 其 中 第 i 个 对 角 元 素 是 上 的 第 i 个 特征 
E, W U 的 特征 值 分 解 是 

U=ESE (10.5) 
AP, E 是 一 个 正 交 矩阵， 其 第 i 列 eE UWE i 
个 特征 向 量 , 的 第 i 个 特征 向 量 用 Re, 表示 。 如 果 
将 局 的 特征 值 分 解 带 和 人 到 J 的 极 值 分 解 式 (10.3) 
中 ， 得 到 

J = RESE" (10.6) 
ERE J AAT RAB, SEARRE J 
的 奇异 值 。 

PATE AT LA 24 h IE ia oe BRA, x (10.1) JUL 

何 解释 ， 为 此 将 其 改写 为 


t = RUQ (10.7) 


XP PAE AT EAS, MEn HEERA, U. 


也 可 逆 ， 由 上 式 可 得 到 
0 =U-'R't (10. 8) 
进一步 ， 如 果 假 定 复 合 速 度 问 量 1 AK RE 
HO 的 所 有 元 素 都 有 同样 的 物理 单位 ， 即 纯 平 动 或 
纯 转 动机 器 人 的 情况 ， 则 可 以 对 (10.8) 取 两 端 取 

欧 几 里 德 模 数 ， 得 到 

la |È =eRD-2RTt (10.9) 
将 也 用 它 的 特征 值 分 解 ， 式 (10.5) RÆ, 


lle |? < RES ER't 





如 果 定 义 
y=ER't (10. 10) 
则 上 式 变 为 
yy -?y = |la |P (10. 11) 
WR v 的 第 i 个 元 素 记 作 vw;，i=1，…，n， 对 于 
8 内 的 单位 球 上 9 上 =1， 式 (10. 11) 变 为 
1 (10. 12) 


即 儿 空间 ,或 笛 卡 儿 速 度 空间 中 半 轴 分 别 是 
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io;i1 的 李 球 的 标准 方程 。 需 要 指出 ， 该 椭 球 只 有 在 
特定 的 坐标 系 内 才能 表述 为 标准 形式 ， 即 坐标 轴 的 方 
癌 与 U 的 特征 回 量 的 方向 一 致 。 椭 球 在 8 空间 内 的 通 
用 表达 式 是 
t REY E'R't=1 (10. 13) 
ALZ, KH E M H — A AZ Re HE n He E BE 
”映射 为 一 个 椭 球 ， 其 半 轴 长 度 是 J 的 奇异 值 。 即 
了 将 关节 速度 空间 的 单位 球 扭曲 为 末端 操作 手 复合 速 
上 度 空 间 的 一 个 椭 球 。 这 种 扭曲 可 以 作为 由 机 此 人 结构 
决定 的 运动 和 力 传递 质量 的 一 个 度量 ; 扭曲 越 小 ， 传 
递 的 质量 越 高 。 
由 雅 可 比 矩 阵 导 致 的 扭曲 的 度量 还 可 以 被 定义 为 
J 的 最 大 奇异 值 ow 和 最 小 奇异 值 之 加 的 比例 ， 也 
被 称 为 了 的 条 件数 xk;,， 利 用 矩阵 的 2 范 数 “ FS 








(10. 14) 


Ky, = 
oO 


实际 上 ， 式 (10.14) 只 是 计算 J 或 任意 mxn 
维和 矩阵 的 条 件数 的 可 能 方法 之 一 ， 而 不 是 效率 最 高 
的 。 这 种 定义 中 要 求 已 知 雅 可 比 和 矩阵 的 奇异 值 。 但 
是 ， 奇 异 值 和 特征 值 的 计算 量 都 很 大 ， 再 加 上 极 值 分 
解 的 计算 量 ， 这 样 做 的 计算 量 只 是 略 小 于 奇异 值 分 解 
的 计算 量 '"”i。 对 于 一 个 nxn 维 的 矩阵 ， 条 件数 的 
更 通用 的 定义 是 |: 
K(A) = lla Illa || (10. 15) 
如 上 所 述 ， 式 (10.14) Æ% (10.15) FR ME 
阵 2 范 数 获得 的 。 和 矩阵 的 2 范 数 定义 为 
|A|, =max{ø;} (10.16) 
另 一 方面 ， 可 以 采用 矩阵 的 加 权 Frobenius 范 数 ， 定 
义 如 下 


Al) tr(AA") =, /—tr( ATA) (10. 17) 


显然 ， 奇 异 值 的 计算 被 避免 了 。 如 果 在 上 述 定义 中 省 
略 权 值 -一 ， 就 得 到 标准 的 Frobenius 范 数 。 在 工程 中 


加 权 Frobenius 范 数 应 用 更 为 广泛 ， 因 为 它 不 取决 于 
矩阵 的 行 和 列 数 。 加 权 Frobenius 范 数 实 际 上 得 到 奇 
异 值 的 均 方 根 值 (rms), 

基于 矩阵 的 Frobenius 73, FY LA $e BNE A] EE AB 
阵 J AY Frobenius 条 件数 rp 


kr(J) = Vir I) Sel PY 
= Vi FD Ve FD (10.18) 


上 述 两 种 计算 矩阵 的 条 件数 的 方法 之 间 还 有 一 点 
重要 差别 : r(e) 是 它 的 自 变量 矩阵 的 解析 函数 ， 
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(+) 则 不 是 。 因 此 基于 Frobenius 范 数 得 到 的 条 件 
数 在 机 器 人 结构 设计 中 拥有 巨大 的 优势 。k,( . ) 是 
可 微 的 ， 可 用 于 基于 梯度 的 优化 方法 ， 运 行 远 远 快 于 
仅 依 徘 函 数 评 价 的 直接 方法 。 在 要 求实 时 计算 的 机 器 
人 控制 中 ,kes(， ) 也 体现 出 优势 ， 因 为 在 计算 过 程 
中 不 需要 计算 奇异 值 ， 只 需要 进行 矩阵 求 着 ,所 以 速 
度 更 快 。 

我 们 注意 到 条 件数 的 概念 来 源 于 由 线性 系统 方程 


(10.1) 求解 8 的 过 程 ， 这 有 助 于 更 好 地 理解 条 件数 
在 机 器 人 设计 和 控制 中 的 重要 性 。J 是 结构 参数 和 姿 
态 变量 0 的 函数 ， 其 中 必然 包含 已 知 等 级 的 误差 。 结 
构 参 数 ， 也 就 是 Denavit- Hartenberg 表 中 的 常数 ， 被 
存储 在 向 量 p 中 , p 和 0 中 必然 包括 各 自 的 误差 8p 
和 869。 此外， 机 器 人 控制 软件 的 输入 ， 复 合 速度 ft 也 
不 可 避免 地 含有 误差 Bt 


采用 浮 点 数 求解 式 (10.1) 得 到 8 的 过 程 中 ， 


得 到 的 结果 必然 包含 截 尾 误差 8 。8 中 的 相对 误差 
受 结构 参数 和 姿态 变量 的 相对 误差 影响 [903 
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lg | lp ll lell Tel 
AF, p HORRA (AAA) 实际 值 ; t 代表 复 
合 速度 的 名 义 值 。 

然而 ， 上 述 讨论 中 的 任务 包括 位 置 或 姿态 要 求 ， 
但 不 同时 包括 两 者 。 现 实 中 ， 大 多 机 器 人 任务 既 包 括 
人 位置， 又 包括 姿态 要 求 ， 这 样 雅 可 比 矩 阵 的 不 同 元 素 
其 有 不 同 的 单位 ， 从 而 其 奇异 值 也 具有 不 同 的 单位 。 
和 位 置 相关 的 奇异 值 具 有 长 度 单位 ， 和 姿态 相关 的 是 
无 量 纲 的 。 这 样 ， 就 不 可 能 对 所 有 奇异 值 排序 或 
求 和 。 

为 处 理 这 一 问题 ， 并 计算 雅 可 比 矩 阵 的 条 件数 ， 
特征 长 度 的 概念 被 提出 ”'" 。 特 征 长 度 工 被 定义 为 
在 某 个 最 优 姿态 下 ， 雅 可 比 矩 阵 的 带 有 长 度 单位 的 元 
素 被 分 离 出 来 使 得 雅 可 比 和 矩阵 的 条 件数 达到 最 小 值 的 
长 度 。 因 为 定义 的 方式 非常 抽象 ， 缺 乏 清 晰 的 几何 意 
义 ， 使 其 在 机 器 人 领域 的 应 用 非常 困难 。 为 提供 明确 
的 几何 意义 ， 最 近 齐 次 空间 的 概念 被 提出 所 3 Al 
用 这 一 概念 ， 机 器 人 结构 在 一 无 量 纲 空间 中 设计 ， 所 
有 点 的 坐标 都 是 无 量 纲 实数 。 这 样 做 ， 一 条 直线 的 六 
个 Plicker 坐标 '" ”1 也 都 是 无 量 纲 的 。 机 器 人 的 雅 可 
比 矩 阵 的 每 一 列 对 应 转动 轴线 的 Plicker 坐标 ， 也 是 
无 量 网 的 。 雅 可 比 和 矩阵 的 奇异 值 也 是 无 量 纲 的 ， 则 其 
条 件数 可 以 被 定义 。 对 应 最 小 条 件数 ， 确 定 机 器 人 的 
结构 时 ， 若 满足 若干 几何 约束 ， 如 杆 件 长 度 比 例 和 相 











邻 关 节 轴 线 间 的 角度 ， 可 以 得 到 机 器 人 的 最 大 可 达 范 
围 。 这 个 最 大 可 达 范 围 > 是 一 个 无 量 纲 数 ， 将 其 与 规 
定 的 拥有 长 度 单位 的 最 大 可 达 范 围 R 相 比较 ， 特 征 
长 度 就 是 比例 上 = R/r。 


10. 3.2 基于 动力 学 的 局 部 性 能 评价 


既然 运动 是 由 力 或 力矩 作用 在 刚体 上 造成 的 ， 一 - 
个 自然 的 想法 是 定义 考虑 机 构 的 惯性 特性 的 性 能 指 
标 。Asada “定义 了 广义 惯量 椭 球 〈GIE) ， 即 对 应 
G=J MJ REER, FEH M 是 机 械 手 的 惯量 矩阵 。 
这 个 椭 球 的 半 轴 是 上 文 介绍 的 奇异 值 。Yoshikawal'**) 
定义 了 相应 的 动态 操作 性 度量 为 det[ JM (JM-')"]。 
从 物理 角度 看 ， 这 些 概念 对 应 两 种 现象 。 若 将 机 器 人 
视 为 一 个 输入 -输出 设备 ， 即 给 定 关 节 力 矩 ， 产 生来 
wn Pe TE Ab AY De. Yoshikawa 的 指标 反映 这 种 力 
第- 加 速度 增益 的 一 致 性 ，Asada 的 广义 惯量 椭 球 表 
征 这 个 增益 的 逆 。 如 果 一 个 操作 者 握 住 机 器 人 的 末端 
间作 手 党 试 移动 机 器 人 ， 广 义 惯量 椭 球 将 反映 机 器 人 
对 这 种 末端 操作 手 运 动 的 阻抗 。 

其 他 将 机 器 人 的 性 能 视 为 动力 学 的 函数 的 度量 包 
括 : Voglewede 和 Ebert- Uphofft 27! 提出 的 基于 关节 
刚度 和 杆 件 惯量 的 性 能 指标 ， 其 目的 是 确定 由 机 器 人 
的 任意 姿态 到 奇异 状态 之 间 的 距离 。Bowling 和 Khat- 
ib “提出 了 广义 坐标 系 来 评价 一 个 广义 机 械 手 的 动 
态 能 力 ， 其 中 包括 了 末端 操作 手 的 速度 和 加 速度 ， 还 
考虑 了 力 窍 和 执行 器 所 受 的 速度 限制 。 


10. 3.3 全 局 灵巧 性 度量 


上 述 度 量 值 都 只 具有 局 部 意义 因为 它们 都 只 针对 
给 定 的 姿态 。 局 部 度量 对 很 多 应 用 具有 意义 ， 如 宛 余 
求解 和 工件 定位 。 为 了 设计 目的 ， 更 需要 一 种 全 局 的 
度量 。 将 局 部 度量 推广 到 全 局 的 一 个 直观 方法 是 将 局 
部 度量 在 整个 可 行 的 关节 空间 积分 。 在 参考 文献 
[10.39] 中 ，Gosselin 和 Angeles 将 雅 可 比 条 件数 在 
整个 工作 空间 上 积分 来 定义 一 种 全 局 度量 ， 被 称 为 全 
局 条 件 指标 。 对 于 简单 的 情况 ， 如 平面 定位 和 球形 机 
械 手 ， 全 局 条 件 指 标 和 对 应 的 局 部 度量 完全 吻合 。 


10.3.4 闭 链 灵 巧 性 指标 


建立 财 链 的 灵巧 性 具有 若干 不 同 点 。 第 一 个 明显 
的 差别 是 财 链 的 关节 配置 空间 不 再 是 平坦 的 ， 一 般 情 
况 下 是 高 维 空间 内 的 曲面 。 此 外 ， 与 开 链 情况 不 同 ， 
闭 链 的 正 运 动 学 问题 比 逆 运 动 学 问题 更 困难 ， 有 可 能 
存在 多 个 解 。 另 一 个 重要 区 别 是 尽管 只 有 部 分 关节 是 
可 以 主动 驱动 的 ， 这 个 数目 仍然 可 能 超过 机 器 人 的 自 
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由 度数 目 。 

一 些 针 对 特定 机 构 :“” 和 所 有 关节 都 可 被 驱动 
的 协作 机 器 人 系统 “全 的 基于 坐标 的 闭 链 灵巧 性 
度量 已 经 被 提出 ， 部 分 方法 得 到 的 结果 相互 克 
盾 “*“**。 由 于 上 文 介 绍 的 闭 链 机 构 独 有 的 非 线 性 
特性 ， 为 它们 建立 基于 坐标 的 灵巧 性 度量 时 需要 特别 
关注 。 

另 一 个 新 近 的 研究 方向 是 为 闭 链 结 构 的 灵巧 性 
建立 不 随 坐 标 系 变化 的 微分 几何 表达 式 。 在 这 个 框 
架 下 关节 和 末端 操作 手 配 置 空间 被 视 为 通过 适当 选 
择 的 Riemannian 度量 的 Riemannian #47} 23 [A] FR, 其 
HKH E fia] BE tek BY ae FR Be BRE AT aS PE AY 
串联 结构 开发 的 椭 球 概念 也 可 以 被 推广 到 通用 的 闭 
链 情况 ， 可 以 包括 主动 和 被 动 关节 ， 包 括 元 余 驱 动 
情况 00.45.46] 。 


10.3.5 修正 的 类 灵巧 性 度量 


上 述 对 灵巧 性 的 不 同 定 义 都 定性 地 反映 机 天 
人 沿 任意 方向 运动 和 施加 力 的 能 力 。Liegeoist'*” 
和 Klein，Huang *' HM TER, RAT AR A 
角 ， 其 中 灵巧 性 通过 关节 范围 的 可 实行 性 来 定量 
地 描述 。 这 样 做 的 动机 是 因为 大 部 分 机 器 人 关节 
都 存在 限制 ， 因 此 应 将 关节 到 达 停 止 位 置 的 可 能 
性 降 到 最 低 。 

Hollerbach 人 采用 了 一 种 修正 的 方法 来 设计 一 
个 宛 余 的 7R 机 械 手 ， 考 虑 的 因素 包括 : 中 避免 内 部 
奇异 点 ; 四 工作 空间 中 的 避 障 能 力 ; 人 @ 运 动 学 方程 的 
可 解 性 ; @ 机 械 的 可 构建 性 。 基 于 这 四 条 准则 ， 他 得 
到 了 一 种 特定 的 7R 设计 ， 和 人 类 手臂 具有 相同 的 形 
态 构 型 ， 两 个 球 关节 相当 于 肩 关 节 和 和 脐 关 节 ， 以 及 一 
个 转动 关节 相当 于 肘 关节 。 通 常情 况 下 ， 锁 定 元 余 机 
器 人 的 一 个 关节 ， 机 器 人 仍然 可 以 完成 普通 的 六 日 由 
度 任务 ， 对 于 该 结构 ， 如 果 锁 定 肘 关节 ， 该 机 器 人 将 
失去 这 种 操作 能 力 。 

从 控制 角度 出 发 ，Spong'* ”| 指出， 如 果 机 械 手 
的 惯量 矩阵 具有 消失 的 Riemannian 弯曲 ， 则 存在 一 
系列 坐标 系 ， 在 其 中 运动 方式 可 以 具有 特别 的 简化 形 
式 。 惯 量 和 矩阵 的 弯曲 也 反映 了 动力 学 特性 对 某 些 机 带 
人 参数 的 敏感 度 。 最 小 化 这 种 弯曲 ， 是 另 一 种 可 能 的 
机 器 人 设计 标准 。 


10.4 其 他 性 能 指标 


10.4.1 加 速度 半径 
另 一 种 表征 机 械 手 动态 能 力 的 度量 是 加 速度 半 
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径 ， 最 初 由 Graettinger 和 Krogh 在 参考 文献 110.51] 
中 提出 ， 其 意义 是 给 定 执行 右 所 受 的 力矩 限制 ， 反映 
末端 操作 手 在 任意 方向 上 的 最 小 加 速度 能 力 。 特 别 
地 ， 给 定 一 个 串联 链 的 动力 学 方程 

T=M(0)0 +C(0,0)0 (10. 20) 
式 中 , 邮 是 机 器 人 的 质量 矩阵， 也 被 称 为 关节 空间 


中 的 惯量 矩阵 ; C0, 0) 是 由 关节 速度 向 量 到 科 氏 
力 和 离心 力 矢量 的 映射 矩阵 。 执 行 器 受到 力矩 限制 ， 
形 如 
Tmin ST ST max (10. 21) 

HARK BRIE BE SW ETa, Tom e R" FE RRL SE 
姿态 8 的 函数 。 末 端 操 作 手 复合 速度 的 变化 率 上 为 
| i =J(0)0 +J (0,0) 
sth, J(0, 0) 是 雅 可 比 矩 阵 的 时 间 导 数 。 假 设 
J0) 是 非 奇异 的 ， 可 以 得 到 

8 =1(0) i -J(0) J (0,t) 
将 上 式 代 人 动力 学 方程 (10. 20) ， 得 到 

T(0,t,t) =M'(@)t +C’(6,t) 


(10. 22) 


(10. 23) 


(10. 24) 
其 中 
_M'(@) =M(@)J(0) 一 


C'(9,t) =[C(6,t) —M(@)J(0) J (0,t) U7! (0) 


对 于 给 定 的 状态 (9，9 ) ， 线 性 力矩 限制 (10.21) 
定义 了 一 个 复合 加 速度 空间 内 的 多 面体 。Greaetinger 
和 Krogh! °°" 将 加 速度 半径 定义 为 中 心 在 原点 ， 完 全 
包含 在 这 个 多 面体 内 的 球 的 最 大 半径 。 其 代表 末端 操 
作 手 在 任意 方向 的 最 小 加 速度 。 这 个 概念 被 用 来 衡量 
机 械 手 的 加 速度 能 力 ， 也 被 用 来 确定 执行 器 的 尺寸 来 
获得 期 望 的 加 速度 半径 。Bowling 和 Khatib ”将 这 
一 概念 推广 以 衡量 末端 操作 手 的 力 和 加 速度 能 力 ， 定 
量 描述 机 械 手 的 最 差 动 态 表现 。 


10.4.2 静 弹 性 性 能 


静 弹 性 性 能 反映 机 器 人 在 静 平 衡 条 件 下 对 外 加 
负载 - 力 和 力矩 的 响应 。 这 种 响应 体现 为 机 械 手 的 刚 
度 ， 即 末端 操作 手 受 外 加 复合 力 时 的 位 移 和 角度 
形变 。 

机 器 人 形变 有 两 个 来 源 : 杆 件 和 关节 形变 。 对 应 
杆 件 很 长 的 情况 ， 如 空间 机 器 人 -加 拿 大 手臂 2 型 ， 
杆 件 柔 性 是 形变 的 主要 来 源 。 对 于 当今 大 多 数 串 联机 
器 人 ， 形 变 主要 出 现在 关 市 处 。 

在 本 章 中 ,我 们 认为 机 器 人 杆 件 是 刚性 的 ， 关 市 
模型 是 线 弹 性 扭转 弹簧 。 更 复杂 的 杆 件 柔 性 问题 将 在 
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第 13 章 中 深入 介绍 。 关 于 静 弹 性 模型 ， 我 们 的 分 析 
建立 在 一 下 假设 基础 上 : 对 于 定位 任务 ， 关 节 锁 定 在 
某 一 姿态 gm 处， 未 端 操 作 手 受到 复合 力 扰动 Aw HE 
用 ， 其 被 弹性 关节 力矩 AT 所 平衡 。 在 该 条 件 下 ，AB 
和 和 AT 之 间 服 从 著名 的 线性 关系 

KA@=AT (10. 25) 
式 中 , K 是 关节 空间 中 对 应 给 定 姿态 处 的 刚度 矩阵 ， 
是 一 个 对 角 阵 ， 各 对 角 线 元 素 分 别 对 应 各 关节 的 扭转 
刚度 ， 因 此 天 是 姿态 独立 的 ， 即 在 整个 机 器 人 工作 
空间 内 为 常数 和 矩阵 。 另 外， 内 为 所 有 关节 都 具有 有 限 
的 非 零 刚度 ， 内 此 K 是 可 逆 的 ， 其 道 阵 C 被 称 为 柔 
顺 矩 阵 。 可 以 将 (10.25) 式 的 道 表示 为 

A@=CAT (10. 26) 
显然 Ag 和 Az 都 具有 增 量 的 本 质 ， 都 由 平衡 姿态 处 
开始 测量 ， 在 平衡 姿态 处 ， 二 者 均 为 0。 

KT Wl EM, Griffis 和 Duffy! $ H T — 
种 由 刚体 位 移 增 量 Ax 到 复合 力 增 量 Aw 的 不 具有 
对 称 性 的 映射 。 映 射 背 后 的 概念 是 Howard 等 人 在 
参考 文献 [10.53] 中 利用 Lie 代数 方式 提出 的 。 
但 在 上 述 文 章 中 ，Ax 和 Aw 是 不 匹配 的 ， 它们 的 
乘积 并 不 代表 功 的 增 量 ， 因 为 Ar 并 不 出 现在 Aw 
的 作用 上 点， 因此， 上述 映射 的 矩阵 形式 并 不 代表 
刚度 矩阵。 

给 定 相同 幅 值 的 Ar， 变形 在 与 C 的 最 大 特征 
值 ， 即 的 最 小 特征 值 (表示 为 kw,) ， 对 应 的 特征 
向 量 方向 上 的 形变 最 大 。 关 于 静 弹 性 性 能 ， 我 们 的 
目标 是 : 中 最 小 化 最 大 形变 ， 即 最 大 化 ka Olt 
形变 的 幅 值 |Ael 尽 可 能 关于 负载 Az 的 作用 方向 不 
敏感 。 可 以 通过 使 及 ,, 尽 可 能 接近 天 来 实现 。 第 
一 个 日 标 与 刚度 常数 相关 ， 该 常数 越 大 ， 形 变 越 小 。 
第 二 个 目标 涉及 各 向 同性 ， 最 理想 的 情况 是 KK 的 所 
有 特征 值 都 相等 ， 即 天 本 身 是 各 向 同性 的 。 由 于 串 
联机 器 人 的 金字 塔 效应 ， 即 靠近 机 座 的 电动 机 需要 
文 撑 其 后 所 有 部 分 ， 整 体 的 刚度 由 靠近 机 座 的 关节 
决定 ， 因 此 ， 串 联机 械 手 不 可 能 具有 各 向 同性 的 刚 
FEJE BA 

式 (10.25) Ast (10.26) 也 可 以 在 任务 空间 
中 表述 为 





K, Ax = Aw (10. 27) 

AP, AvstAt, At 代表 一 个 时 间 间 隔 微 量 ， 在 此 期 
间 内 末端 操作 手 的 姿态 变化 微量 是 Ax， 即 

Ax =J0 At = JA@ (10. 28) 

是 一 个 由 关节 增 量 向 量 到 位 姿 增 量 向 量 的 线性 变换 。 

下 面 我 们 将 说 明 删 度 矩 阵 不 是 坐标 系 不 变 的 ， 即 在 由 
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关节 空间 到 笛 卡 儿 空 间 的 线性 变换 中 ， 刚 度 和 矩阵 不 满 
是 相似 变换 。 我 们 首先 简要 回顾 相似 变换 的 定义 ， 如 
AY = Lx 是 一 个 由 R" 空 间 到 其 自身 的 线性 变换 ，5 引 
入 癌 量 基 的 变化 ,x = Ax, y = Ay, WL ee’, 
即 满足 下 式 

L’ =ALA `! (10.29) 
上 述 变 换 将 R" 空 间 内 的 任意 向 量变 换 为 同一 空间 内 
的 男 一 向 量 ,将 矩阵 工 变换 为 L'， 如 式 (10.29) 所 
不 ， 称 为 相似 变换 。 因 为 4 代表 坐标 系 之 间 的 转换 ， 
所 以 其 必然 可 逆 。 

现在 ， 由 式 (10.28) 和 式 (10.27) 给 出 的 坐 

标 变 换 ， 可 以 得 到 

K.JA@=J AT 
其 中 我 们 需要 利用 动态 静 力 学 关系 1 

J'Aw=AT 
在 此 ， 指 数 项 -T 意 味 着 逆 的 转 置 ， 或 转 置 的 送 。 在 
式 (10.30) 两 端 同时 左 匀 三， 可 以 得 到 ; 

J KJAG=AT (10. 31) 

比较 式 (10.25) 和 式 (10.31)， 可 以 得 到 关节 

空间 的 刚度 矩阵 天 和 笛 卡 儿 空 间 的 刚度 矩阵 K. 之 间 
的 关系 


(10. 30) 


K=J KJ 或 Ke =J "KJ (10. 32) 
显然 处 和 KK 之 间 不 满足 相似 变换 。 意 味 着 这 两 
个 矩阵 不 会 具有 完全 相同 的 特征 值 ， 它 们 的 特征 向 量 
也 不 能 通过 式 (10.28) 描述 的 线性 关系 相关 联 。 事 
实 上 ， 如 果 机 器 人 是 转动 看 合 的 ， 它 的 刚度 矩阵 K 
的 元 素 都 具有 单位 N. m， 即 扭转 刚度 ， 而 .的 元 素 
具有 不 同 的 单位 。 为 说 明 这 点 ,将 雅 可 比 和 矩阵 和 其 
逆 ， 以 及 两 个 刚度 和 矩阵 都 分 解 为 四 个 3 x3 的 子 
块 ， 即 


Ji J 1 Ji Ji 
fa a 
Ja Jy Ja Ja 
K,, Ko Ko, Koz 
“la e) ole e 
Kı K} Ke, Koz 


由 复合 速度 的 定义 式 (10.2) 可 知 , J Ay 
部 分 的 两 个 子 块 是 无 量 纲 的 ， 它 的 下 半 部 分 的 两 
个 子 块 具有 长 度 单位 “…” | Bite, J Ze AAS 
子 块 是 无 量 纲 的 ， 其 右 侧 的 两 个 子 块 具有 首长 度 
单位 。Kc 的 各 子 块 可 由 式 (10.32) 所 示 的 关系 
得 出 : 

Koy =J (Ky J +KoJa) + Jy (Kid, + Kyd) 
Key = J"), (Ki Jip + Ky Jy) + Jn (Kid, + Ky Jy ) 
Keo, = Kc 
Koy = J) (Ky Jin + Ky Jin) tJ (Kind, + KJ ) 
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显然 ， 天 的 元 素 的 单位 是 N . m， 即 扭转 刚度 ， 
Ks 和 wj 的 元 素 的 单位 是 N，Ki 的 元 素 的 单位 是 
N/Am， 即 平移 刚度 。 

上 述 讨论 的 结论 是 可 以 得 到 于 的 范 数 ， 但 不 能 
直接 得 到 K.. 的 范 数 ， 除 了 引 人 特 征 长 度 使 得 .的 所 
有 元 素 成 为 齐 次 无 量 纲 的 。 甜 阵 的 范 数 是 有 用 的 工 
具 ， 因 为 它 表 征 和 矩阵 的 元 素 有 和 多大。 我 们 希望 确定 机 
器 人 在 关节 空间 和 笛 卡 儿 空 间 的 刚度 如 何 ， 在 关 下 空 
间 ， 我 们 可 以 采用 任何 范 数 ， 需 要 指出 ， 式 (10.3) 
介绍 的 2 范 数 并 不 适合 ， 内 为 它 会 把 最 强 的 关节 的 刚 
度 赋予 整个 机 器 人 系统 ， 更 合适 的 方式 是 采用 式 
(10.17) 描述 的 加 权 Frobenius WW, EXHB RP 
刚度 的 均 方 根 值 。 

为 实现 机 器 人 的 最 优 设计 ， 我 们 将 力求 获得 在 关 
节 空 间 的 刚度 矩阵 的 Frobenius 范 数 的 最 大 值 ， 同 时 
兼顾 机 器 人 重量 的 约束 。 因 为 如 果 所 有 的 关节 都 选用 
ROME, HIRO ERIKA ee. 


10.4.3 动弹 性 性 能 


对 于 一 个 通用 的 设计 问题 ， 不 仅 动态 静 力 学 和 毅 
弹性 性 能 ， 还 需要 考虑 动弹 性 性 能 。 因 此 ， 我 们 在 
10. 4.2 节 介 绍 的 假设 的 基础 上 ， 增 加 一 个 条 件 ， 即 
考虑 由 杆 件 质量 和 转动 惯量 导致 的 惯性 力 。 

在 给 定 的 姿态 mg， 忽略 阻尼 项 ， 一 个 串联 机 货 
人 的 线性 化 模型 可 写成 


MAG +KA@=AT (10. 33) 

式 中 ,，M 是 10. 4. 1 节 中 介绍 的 n xn 维 正定 质量 阵 ， 

K 是 10.4.2 节 中 介绍 的 关节 空间 中 的 nxn 维 止 定 刚 

EERE, M 和 外 都 在 关节 空间 坐标 系 内 定义 ，A0 代 

表 关 节 变 量 弹 性 位 移 向 量 。 这 些 位 移 产 生 的 前 提 是 各 

关节 被 锁定 在 位 置 处， 具有 理想 的 线 弹 性 特性 。 

机 器 人 受到 扰动 AT 的 作用 ， 或 存在 一 个 不 为 零 的 初 
wae, MOA PE. 

在 自由 振动 情况 下 ， 即 系统 (10.33) 的 运动 由 

非 零 初 始 条 件 导致 ， 扰 动 Az 为 零 ， 则 可 由 上 述 方程 


求解 出 Ab : 








A@ = -DAG,D=M-'K (10. 34) 
式 中 , DD 被 定义 为 动力 学 矩阵 。 其 决定 被 考虑 的 系统 
的 行为 ， 因 为 它 的 特征 值 就 是 系统 的 固有 频率 ， 而 其 
特征 向 量 对 应 系统 的 模 态 向 量 。 以 oh A {fj 1 分 
别 代表 DD 的 特征 值 和 特征 向 量 的 集合 。 在 初始 条 件 


[A@(0), A0 (0) ] "情况 下 ， 其 中 A9(0) 与 DD 的 第 i 
个 特征 向 量 成 比例 ， 且 Ag (0) =0， 则 系统 的 运动 形 





RA A8(1) = AA(0) cosw;t! , 

进一步 ,在 式 (10.28) 描述 的 变化 情况 下 ， 模 
型 (10.33) 变化 为 

MJ 'Ax +KJ 'Ax=J Aw 

TEE sh SES Pe AB FELT", 可 以 得 到 模型 

(10.33) 在 笛 卡 儿 坐 标 系 下 的 动弹 性 模型 
J MJ Ax + KJ Ax = Aw 

EL op Ss — “758 EE FR FILER FR AE 


M.=J MJ (10. 35) 

第 二 个 系数 是 式 (10.32) PER Keo FER KIL 
标 系 下 的 动弹 性 模型 可 以 写 为 

MAX +K,Ax = Aw (10. 36) 


再 次 重申 ， 由 变换 (10.35) 可 知 ， 与 刚度 矩阵 类 似 ， 
质量 符 阵 同样 不 具有 在 不 同 坐 标 系 下 的 不 变性 。 对 于 转 
动 耦合 型 机 器 人 ，M 的 所 有 元 素 的 单位 都 是 kg : m ， 
但 M. 的 元 素 具有 不 同 的 单位 。 与 10.4. 2 节 中 对 笛 卡 
儿 空 间 中 的 刚度 矩阵 进行 的 类 似 的 分 析 表 明 ， 如 果 将 
M. 分 解 为 4 个 3 x3 的 子 块 ， 则 它 的 左上 子 块 具 有 转 
动 惯量 单位 ， 它 的 右 下 子 块 具有 质量 单位 ， 其 他 非 对 
角 块 的 单位 是 kg. m。 
箔 卡 儿 空间 中 的 动力 学 矩阵 相应 变化 为 

D, = MT 天 (10. 37) 
证 明 动 力学 矩阵 具有 相对 坐标 系 的 不 变性 非常 简单 。 
将 变换 (10.32) 和 “(10.35) 代入 式 (10.37) ， 可 
以 得 到 

De=JM JJ TKI =JM KI 

H PIURA TA A PE D 的 表达 
式 ， 因 此 有 

D, =JDJ (10. 38) 
也 就 意味 着 DÆ D 的 相似 变换 。 从 而 ， 动 力学 矩阵 
在 坐标 系 改 变 时 具有 不 变性 ， 即 两 个 矩阵 具有 相同 的 
特征 值 集 合 ， 它 们 的 特征 向 量 之 间 满 足 同样 的 相似 变 
换 。 如 果 DD 在 关节 空间 中 的 模 态 向 量 记 为 [fiji X 
应 第 卡 儿 空间 内 的 模 态 向 量 记 为 {8;11， 则 这 两 个 集 
合 之 间 的 相互 关系 是 

g; = Jf, (10. 39) 

因此 ， 无 论 在 哪个 空间 中 计算 ， 动 弹性 模型 的 固 
有 频率 总 是 相同 的 ， 振 动 的 自然 模 态 的 变换 符合 相似 
变换 。 

在 零 初始 条 件 下 ， 受 到 形 如 AT= Bocoswt 的 激励 
作用 时 ， 系 统 的 响应 将 是 频率 为 w 的 简 谐 运动 ， 其 
幅 值 将 同时 取决 于 mw 和 系统 的 频率 谱 oli 
[10.54], 4o 等 于 系统 的 自然 频率 时 ， 响 应 的 幅 值 
将 无 限 地 增 大 ， 即 出 现 共振 现象 。 由 于 这 个 原因 ， 在 


i=1,…,n 
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议 计 机 器 人 时 ， 需 要 严格 地 保证 它 的 频率 谱 不 包含 任 
何 期 望 的 工作 频率 。 这 点 可 以 通过 调整 机 器 人 的 质量 
和 刚度 矩阵 来 使 得 机 器 人 的 频率 谱 处 于 所 有 工作 条 件 
的 频率 范围 之 外 来 实现 。 

设计 不 是 一 个 直截了当 的 任务 。 事 实 上 ， 在 关节 
空间 中 刚度 矩阵 是 常数 矩阵 ， 而 质量 矩阵 则 取决 于 当 
前 的 姿态 ， 即 M = M(8) 。 因 为 这 一 特性 ， 机 器 人 的 
动弹 性 设计 是 个 迭代 的 过 程 设计 过 程 如 同一 个 稻草 
人 任务 。 给 定 一 个 典型 的 任务 ， 包括 一 系列 的 姿态 ， 
对 应 存在 一 系列 的 质量 矩阵 。 随 后 ， 对 应 所 有 这 些 次 
态 的 频率 谱 将 被 设计 处 于 稻草 人 任务 的 频率 范围 之 
外 。 鉴 于 机 器 人 终究 将 执行 与 稻草 人 任务 不 同 的 任 
务 ， 需 要 进行 针对 不 同 任务 的 仿真 由 共振 角度 来 确保 
设计 的 安全 性 。 
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本 章 主要 讨论 元 余 度 求解 的 方法 ， 即 在 求解 逆 
运动 学 问题 时 利用 宙 余 自由 度 的 技巧 。 显 然 ， 这 是 

一 个 与 运动 规划 和 控制 密切 相关 的 问题 。 

本 章 首 先 特别 回顾 了 面向 任务 的 运动 学 及 其 
速度 级 (一 阶 微分 ) 求 朔 的 基本 方法 ， 并 讨论 了 
处 理 运动 学 奇异 的 主要 方法 。 其 次 ， 把 不 同 的 求 
解 运 动 学 元 余 的 一 阶 方 法 分 成 两 大 类 ， 刀 基于 适 
当 性 能 指标 的 优化 方法 和 基于 任务 空间 增 广 的 方 
法 。 为 考虑 例如 力矩 最 小 化 这 样 的 动力 学 问题 ， 
随后 讨论 了 加 速度 级 〈 二 阶 微分 ) 的 元 余 度 求解 
方法 。 还 讨论 了 由 关节 的 循环 运动 产生 循环 的 任 
务 空间 运动 的 条 件 ， 这 是 一 个 重要 的 问题 ， 比 如 
在 工业 上 应 用 一 个 元 余 机 械 辟 完成 重复 性 任务 这 


样 的 场合 。 同 时 还 详细 分 析 了 超 元 余 度 这 种 特殊 
类 型 的 机 械 辟 。 最 后 一 节 对 进一步 学 习 所 需 的 参 
考 读物 进行 了 推荐 。 


运动 学 元 余 的 机 械 居 具有 比 完成 任务 所 需要 的 
更 多 的 关节 ， 这 使 机 器 人 拥有 更 多 的 灵巧 性 ， 这 不 
仅 可 用 于 实现 避 青 异 、 避 关节 超 限 和 任务 空间 避 
障 ， 还 可 用 于 最 小 化 关节 力矩 、 最 小 化 能 量 消 
耗 ， 或 者 一 般 而 言 ， 优 化 某 种 适当 的 性 能 指标 。 


11.1 概述 


当 机 械 璧 具有 比 刚好 能 完成 给 定 任务 所 需要 的 月 
由 度 更 多 的 自由 度 时 候 ， 就 具有 了 运动 学 元 余 度 。 这 
意味 着 ,原则 上 没有 什么 机 械 辟 是 本 质 上 元 余 的 。 更 
准确 地 说 ， 是 存在 某 些 任务 ， 机 械 臂 针对 这 样 的 任务 
时 就 成 了 元 余 的 。 因 为 众所周知 ， 一 般 的 任务 要 求 末 
端 执行 器 跟踪 一 个 运动 轨迹 ， 这 需要 6 个 自由 度 ， 所 
以 具有 7 个 或 更 多 关节 的 机 械 辟 被 当成 是 本 质 上 元 余 
的 机 械 臂 的 典型 例子 。 但 具有 更 少 自由 度 的 机 器 人 ， 
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比如 传统 的 六 关节 工业 机 械 辟 ， 对 于 某 些 任务 而 言 也 
可 能 成 为 运动 学 宛 余 的 ， 例 如 ， 只 是 简单 要 求 末端 执 
行 器 的 位 置 而 对 姿态 没有 约束 的 任务 。 

传统 工业 设计 中 利用 宛 余 是 为 了 增加 对 故障 的 鲁 
棒 性 以 提高 可 靠 性 〈 比 如 处 理 器 或 传感器 宛 余 ) ， 在 
机 械 辟 的 机 械 结构 上 引入 运动 学 宛 余 的 目的 不 止 于 
上 此。 实际 上 ， 使 机 械 臂 具有 运动 学 元 余 的 主要 目的 是 
增加 灵活 性 。 

早期 机 械 辟 设计 方法 的 特点 是 具有 最 小 的 复杂 
E, 设计 目标 是 最 低 的 成 本 和 维护 。 比 如 用 于 完成 
检 - 放 操作 的 平面 关节 型 机 械 辟 (SCARA) 叶 就 是 这 种 








应 性 装配 机 械 手 臂 。 


设计 理念 的 产物 。 可 是 让 机 械 臂 只 具有 能 完成 任务 的 
最 少 关 节 会 在 实际 应 用 中 导致 严重 的 局 限 性 ， 除 了 奇 
异 ， 还 会 遇 到 关节 超 限 或 工作 空间 障碍 问题 。 这 些 问 
题 都 将 使 关节 空间 中 的 禁区 增 大 ， 以 便 在 操作 过 程 中 
te en tim 
间 ， 机 械 辟 的 运动 可 以 事先 在 该 空间 中 进行 规划 ， 

器 人 设备 在 传统 工业 应 用 中 的 情况 就 是 这 样 的 。 

另 一 方面 ， 具 有 比 执行 任务 所 需 更 多 的 自由 度 使 
机 械 臂 能 进行 所 谓 的 自 运动 或 内 运动 ， 即 不 改变 末端 
执行 器 位 姿 的 机 械 臂 运动 。 这 意味 着 末端 执行 器 执行 
同样 的 任务 时 ， 关 节 可 以 选择 多 种 不 同 的 运动 方式 ， 
有 可 能 避 开 禁区 ， 最 终 提高 设备 的 通用 性 。 这 种 特性 
是 在 非 结构 化 或 动态 环境 中 进行 操作 的 关键 ， 而 非 结 
构 化 或 动态 环境 正 是 先进 工业 应 用 和 服务 机 器 人 的 工 
作 环 境 。 

实际 上 上， 如果 规 划 得 当 ， 以 增加 了 灵巧 性 为 特色 
的 运动 学 元 余 机 械 辟 有 可 能 实现 名 奇异 、 避 关节 超 限 
和 工作 空间 避 障 ， 以 及 针对 特定 任务 最 小 化 力矩 /能 
耗 ， 本 质 上 意味 着 机 器 人 机 械 臂 能 达到 较 高 的 自治 
程度 。 

运动 学 兄 余 机 械 臂 的 生物 原型 是 人 类 的 手臂 A 
用 惊讶 ， 手 臂 也 是 术语 学 上 命名 串联 结构 机 械 辟 的 灵 
BOR. Rik, ARF RHA 3 CHRE, H 
部 和 腕 部 各 有 一 个 和 三 个 自由 度 。 固 定 你 的 腕 部 ， 上 比 
如 把 手腕 搁 在 桌子 上 并 在 肩 部 不 动 的 情况 下 移动 手 
肘 ， 就 可 以 很 容易 地 验证 手臂 具有 有 效 的 元 余 度 。 许 
多 机 器 人 模仿 了 人 类 手臂 的 运动 学 配置 ， 并 被 称 为 类 
人 机 械 臂 。 包 括 DLR 轻型 机 器 人 (上 见 图 11.1) 和 三 
ZAR PA-10 机 器 人 (ILE 11.2) 在 内 的 机 严 人 ， 形 
成 了 一 个 七 自由 度 机 械 辟 的 家 族 。 而 Scienzia Machi- 
nale 公司 的 DEXTER (参见 图 11.3) 则 是 一 个 八 目 
由 度 机 器 人 的 例子 。 有 大 量 关节 的 机 械 辟 常常 被 称 为 
“ 超 宛 余 度 ”机 器 人 ， 包 括 文献 中 描述 的 许多 蛇 形 机 
ATA o 








1.1 七 自由 度 DLR 轻型 机 器 人 
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图 11.3 Scienzia Machinale 公司 的 
AB RES DEXTER 


使 用 两 个 及 以 上 机 器 人 设备 共同 执行 同一 项 任 
务 ， 比 如 多 机 械 臂 协调 和 多 指 手 ， 也 会 形成 运动 学 元 
余 。 宛 余 装置 还 包括 车 辆 -机 械 臂 系统 ， 不 过 这 种 情 
况 下 宛 余 度 的 准确 计算 还 必须 考虑 车 辆 本 体 运动 可 能 
出 现 的 非 完整 约束 。 

虽然 要 制造 运动 学 元 余 的 设备 在 机 械 设计 方面 也 
会 出 现 一 些 问题 ， 但 本 章 专注 于 讨论 元 余 度 求解 方 
法 ， 即 在 求解 逆 运 动 学 问题 时 利用 匈 余 自由 度 的 技 
巧 。 这 是 一 个 与 运动 规划 和 控制 密切 相关 的 问题 。 
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11.2 面向 任务 的 运动 学 


描述 关节 型 机 械 臂 形态 的 变量 和 在 适当 空间 中 描 
述 给 定 任务 的 变量 之 间 的 坐标 关系 、 速 度 关 系 和 加 速 
度 关系 都 是 可 以 建立 的 。 尤 其 是 考虑 任务 的 一 阶 运动 
学 还 可 导出 任务 雅 可 比 和 矩阵， 它 是 宛 余 度 求 解 方法 研 
究 的 主要 对 象 。 


11.2.1 任务 空间 方程 


机 械 臂 是 一 个 由 关节 连接 的 刚体 链 。 令 y 为 刚 
体 i 相 对 于 刚体 i-1 的 位 置 变量 ,向 量 g = (9 … 
gw) 就 唯一 地 表示 了 N 关节 串联 机 械 臂 的 形态 。 关 
市 可 以 是 滑 移 关节 或 者 是 转动 关节 ，g, 根据 情况 分 
刘表 示 相 邻 连 杆 的 位 移 或 转角 。 

里 然 机 械 辟 在 “关节 空间 ”中 进行 表示 和 驱动 
比较 自然 ,但 要 方便 地 表示 它 的 操作 却 雪 用 向 量 1 = 
(4…tm) ， 典 型 的 情况 是 该 向 量 表 示 了 机 械 辟 未 端 
执行 器 在 一 个 适当 定义 的 任务 空间 中 的 位 置 。-- 般 情 
OF, M=6, TE t 的 前 三 个 元 素 表示 末端 执 行 期 位 
壮 ， 而 后 三 个 元 素 则 是 末端 执行 器 姿态 的 某 种 最 小 描 
述 ( 比如 欧 拉 角 或 RPY ARR), EE 

t=(p, P, P a B vy]" 

典型 的 情况 是 N=， 因而 关节 能 提供 的 自由 度 
数 不 少 于 末端 执行 器 任务 所 需要 的 。 如 果 严 格 满足 
N > M， 机 械 辟 就 是 运动 学 元 余 的 。 

关节 空间 坐标 向 量 4 与 任务 空间 坐标 向 量 上 的 关 
系 可 以 表示 为 正 向 运动 方程 

t=k (q) 
AF, k, 是 一 个 非 线 性 向 量 函 数 。 
1. 任务 雅 可 比 和 几何 雅 可 比 
考虑 一 阶 微分 运动 学 方程 1 


| t =J,(q)q (11.2) 
式 (11.2) 可 由 (11.1) 对 时 间 求 导 得 到 。 在 


A (11.2) 中 , t 是 任务 空间 速度 向 量 ; 4 是 关节 
空间 速度 向 量 ; J (q) = ok,/ag 是 M x N 的 任务 雅 可 
比 矩 阵 〈 也 称 为 解析 雅 可 比 ) 。 


值得 注意 的 是 ，# 中 关于 末端 执行 器 姿态 的 元 
素 表 示 了 用 于 描述 姿态 的 参数 的 变化 速率 ， 而 不 是 末 
端 执行 器 的 角速度 向 量 。 其 实 , 令 w 表 示 末 端 执行 
通 的 3 x1 平 动 速度 向 量 ，ws 表 示 3 x 1 角速度 向 量 ， 
并 定义 末端 执行 器 的 速度 vy 为 


Vy 
Yy = 
Dy 


(11.1) 


(11.3) 


则 下 面 的 关系 式 成 立 


i =T(t)y, (11.4) 
AF, 了 是 一 个 MMx6 的 变换 矩阵 ， 它 只 是 ;的 函数 。 
当 M =6 时 ， 变 换 矩 阵 了 的 形式 为 
I 0 
r= r) 
AP, LAO 分 别 是 适当 维 数 的 单位 矩阵 和 零 矩 阵 ， 
及 是 一 个 3 x3 的 特定 和 矩阵， 由 描述 末端 执行 器 姿态 


的 表示 方式 决定 。 
对 一 个 特定 的 机 械 辟 ， 映 射 


yy =J(g)g (11.6) 
通过 6 x N SLAB AE TT HAE ME J ELSE Hh 25 Ta BRE AT 
应 的 末端 执行 器 速度 联系 起 来 了 。 几 何 雅 可 比 和 矩阵 是 
机 械 辟 运动 学 分 析 主 要 的 研究 对 象 ， 因 为 可 以 通过 它 
根据 当前 形态 下 的 关节 速度 控制 量 ， 得 出 未 端 执行 器 
的 运动 (表示 为 它 的 刚体 自由 空间 速度 ) 。 

对 比 式 (11.2). sR (11.4) MÈ (11.6)， 可 
得 几何 雅 可 比 和 任务 雅 可 比 之 间 的 关系 为 
Ja) =T(t)J(q) 
2. 二 阶 微分 运动 学 
一 阶 微分 运动 学 式 (11.2) 表示 了 任务 空间 和 
关节 空间 速度 之 间 的 关系 ， 进 一 步 求 它 对 时 间 的 导数 
可 以 得 到 加 速度 的 类 似 关系 


t =J,(q)q +J(g,9)9 
下 式 也 被 称 为 二 阶 微分 运动 学 。 


11.2.2 奇异 


本 市 通过 考虑 奇异 位 形 的 产生 原因 来 分 析 它 在 运 
动 学 逆 解 中 的 作用 。 

1. 表示 法 奇异 与 运动 学 奇异 

如 果 任 务 雅 可 比 矩 阵 J, 在 某 个 位 形 下 是 降 秩 的 ， 
则 这 个 机 器 人 位 形 g 是 奇异 的 。 考 虚 J 在 式 (11.2) 
和 式 (11.8) 中 的 作用 ， 容 易 理解 处 于 奇异 位 形 时 
无 法 产生 末端 执行 器 在 某 些 方向 上 的 速度 或 加 速度 。 
观察 式 (11.7) 可 发 现 更 深层 次 的 问题 ， 奇 异 可 能 
是 因为 变换 矩阵 T 和 几何 雅 可 比 矩 阵 了 有 一 个 不 满 
秩 ， 或 者 都 不 满 秩 。 

TEA AER A EGR 建立 的 末端 执行 器 角速度 


向 量 和 # 中 关于 末端 姿态 的 分 量 之 间 的 数学 关系 有 
Ko HX R 的 表达 式 决定 于 所 用 的 姿态 表示 法 ， 导 
致 了 奇异 的 位 形 因而 被 认为 是 表示 法 奇异 点 。 值 得 
注意 的 是 ， 任 何 一 种 末端 执行 器 姿态 的 最 小 表示 都 会 
产生 表示 法 奇异 。 当 然 对 于 一 个 特定 的 位 形 而 言 ， 会 


(11.5) 





(11.7) 


(11. 8) 
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不 会 产生 表示 法 奇异 是 由 所 采用 的 姿态 表示 方法 决 
定 的 。 

表示 法 奇异 与 机 械 臂 的 真实 运动 能 力 并 没有 直接 
关系 ， 真 实 运动 能 力 可 以 改 用 几何 雅 可 比 矩 阵 了 来 分 
析 。 该 矩阵 的 降 秩 实际 上 是 与 机 械 臂 末端 执行 器 运动 
能 力 的 缺失 相关 的 。 确 切 地 说 ， 此 时 某 些 未 端 执行 器 
速度 是 用 任何 关节 速度 都 无 法 实现 的 。 使 得 了 奇异 的 
位 形 称 为 运动 学 奇异 点 。 

因为 本 章 主 要 关注 微分 运动 学 方程 (11.2) 和 
式 (11.8) 的 求 逆 ， 接 下 来 详细 研究 任务 雅 可 比 矩 
阵 和 它 的 奇异 (包括 表示 法 奇异 和 运动 学 奇异 )。 
考虑 NM 的 情况 ， 以 涵盖 常规 机 械 辟 和 元 余 机 
RE. 

2. FEAT LEW ARES 

为 了 分 析 式 〈11.2) 表示 的 线性 映射 ， 可 对 雅 
可 比 矩 阵 进 行 奇 异 值 分 解 (SVD)。 值 得 注意 的 是 ， 
奇异 值 分 解 是 一 个 强 有 力 的 数学 工具 ， 在 计算 矩阵 的 
秩 和 分 析 近 乎 奇异 的 线性 映射 时 ， 它 是 唯一 可 靠 的 方 
法 。 经 典 的 Golub- Reinsch 算法 ""” 是 计算 任意 矩阵 
奇异 值 分 解 最 有 效率 和 数值 最 稳定 的 算法 ,但 可 能 还 
是 难以 达到 实时 应 用 的 计算 要 求 。 参 考 文献 [11.3] 
提出 了 一 种 利用 机 器 人 甜 阵 计算 特点 的 更 快 算法 ， 有 
可 能 用 于 提高 运动 学 实时 控制 方法 的 性 能 。 

任务 雅 可 比 和 矩阵 的 SVD 可 以 写 为 如 下 形式 





M 
J, = USV" = You! (11.9) 
i=] 


AP, U 是 输出 奇异 向 量 uh) M x M HEEZE; V 
是 输出 奇异 向 量 v, 的 入 xWN 维 正 交 和 矩阵 ; =(S 0) 
是 一 个 M xN HERRER, CRIM x M 维 对 角 线 子 矩 阵 
S 包含 矩阵 JW SHE o;。 请 注意 SVD 是 其 矩阵 变 
量 的 连续 乖 函 数 ， 因 此 当 机 器 人 处 于 当前 位 形 附 近 
时 ,输入 和 输出 奇异 向 量 以 及 奇异 值 的 差别 也 不 大 。 
令 和 矩阵 的 秩 rank(J,) =R, MWA 
O, Z0, > SOR > Og, = =O 
R(T) =span| u,- tp] 
N (J,) =span{Vp,1 pw| 
如 果 任 务 雅 可 比 和 矩阵 是 满 秩 的 (R = MM)， 所 有 
的 奇异 值 都 非 零 ，J 的 值 空间 就 是 整个 的 民 ”， J, 的 
零 空 间 的 维 数 为 N-Ms MERMER, R<M, N 
此 最 后 M-R 个 奇异 值 等 于 零 ，J 的 值 空间 是 R 的 R 
ETZE, J, 的 零 空 间 的 维 数 减少 为 N-R。 下面 从 运 
动 学 角度 对 此 给 出 一 种 解释 。 
(1) 可 达 速 度 ” 当 机 器 人 处 于 某 一 个 位 形 时 ， 
J, 的 值 空间 是 可 以 由 所 有 可 能 的 关节 空间 速度 g 计 
算得 到 的 任务 空间 速度 的 集合 。 因 此 ， 值 空间 就 组 
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成 了 所 谓 的 末端 执行 器 任务 的 可 达 速 度 子 空间 。 前 
R 个 输出 奇异 向 量 就 构成 了 值 空间 BJ) 的 一 个 基 
底 。 因 此 ， 奇 异 的 效果 是 从 可 达 速 度 空间 中 抹 去 了 
一 些 任务 速度 的 线性 组 合 ， 从 而 减少 了 J 的 值 空间 
的 维 数 。 

(2) 零 空间 速度 ”在 每 个 位 形 处 ,J 的 零 空间 
则 是 那些 不 产生 任务 速度 的 关节 空间 速度 的 集合 。 这 
样 的 关节 速度 因此 被 简称 为 零 空间 速度 。 后 N-R 个 
输入 奇异 向 量 构成 了 零 空 间 .4 ) 的 一 个 基底 ， 这 
些 向 量 表示 每 个 关节 速度 的 线性 无 关 组 合 。 从 这 种 意 
义 上 说 ， 奇 异 的 效果 是 因为 引入 了 更 多 的 不 产生 任务 
速度 的 关节 速度 线性 无 关 组 合 ， 增 加 了 J 的 零 空 间 
的 维 数 。 

Hast (11.2) AR (11.9) 可 知 , 平行 于 第 i 个 
输入 奇异 向 量 的 关节 速度 所 产生 的 任务 速度 与 第 i 个 
输出 奇异 向 量 平行 : 

Vp eR 9 =pv,=>t=o.pu, AKE: 此 公式 中 
的 上 应 为 上 的 导数 上 。 原 文 有 误 ) 

Bh, J, 的 第 i 个 奇异 值 可 以 看 成 是 一 个 增益 系 
We, vy 方向 的 关节 速度 空间 运动 到 所 产生 的 uw 方向 任 
务 速度 空间 运动 之 间 的 一 个 系数 。 当 机 器 人 靠近 某 个 
AREN, E RAAR EFE, BAË ve 
方向 的 给 定 大 小 关节 速度 所 产生 的 任务 速度 也 按 比 例 
下 降 。 当 机 器 人 处 于 某 个 奇异 位 形 时 ， 沿 着 vA 
的 关节 速度 属于 零 空 间 速度 ， 沿 着 ux 方向 的 任务 空 
间 速 度 变 得 无 法 实现 。 | 

一 般 情 况 下 ， 关 节 空 间 速 度 9 是 在 所 有 vr tf 
上 都 含有 非 零 分 量 的 各 关节 速度 的 一 个 任意 的 线性 组 
合 。 总 的 效果 可 以 通过 合并 单个 上 述 分 量 的 效果 来 分 


析 。 值 得 注意 的 是 ，g 的 属于 J 零 空 间 的 部 分 会 引 
起 机 械 臂 位 形 的 变化 ， 却 不 改变 任务 空间 速度 。 这 种 
运动 可 以 用 于 在 实现 期 望 的 任务 运动 的 同时 实现 附加 
的 目标 ， 比 如 壁 障 或 避 奇 异 。 这 正 是 元 余 度 求解 算法 
研究 的 核心 内 容 。 

3. 到 奇异 点 的 距离 

奇异 不 仅 在 奇异 点 ， 而 且 在 奇异 点 相 邻 的 位 形 处 
都 会 造成 影响 ， 这 在 实际 经 验 中 确定 无 疑 。 因 此 ， 根 
据 某 种 适当 的 标准 来 表示 一 个 位 形 与 奇异 点 的 距离 就 
非常 重要 ， 可 以 用 来 避免 不 良 影响 。 

因为 每 个 奇异 点 都 与 J 的 降 秩 相关 ， 当 雅 可 比 
MEAT RE (M=N) 时 ， 一 种 概念 上 很 简单 的 可 能 
方法 就 是 计算 它 的 行列 式 。 可 操作 性 指标 “就 是 这 
一 思路 对 非 方 阵 雅 可 比 的 一 个 推广 ， 其 定义 为 


w= |S | 
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众所周知 ， 可 操作 性 等 价 于 J 的 奇异 值 的 乘 
积 ， 即 


w= [Tr. 
因此 ， 它 的 零 值 就 对 应 着 奇异 。 
乙 一 种 到 奇异 点 上 距离 的 合理 指标 是 雅 可 比 和 矩阵 的 
条 件数 …” ， 定 义 为 


条 件数 的 取 值 范围 是 1 ~ w 。 在 奇异 值 都 相等 的 
位 形 处 ， 取 值 为 1。 在 奇异 位 形 处 取 值 为 w 。 请 注意 
当 k=1 时 ， 所 有 奇异 值 都 是 相等 的 ， 因 此 末端 执行 
露 在 任务 空间 的 所 有 方向 上 的 运动 能 力 都 是 一 样 的 ， 
即 机 械 辟 处 于 一 种 各 向 同性 的 位 形 ， 而 在 奇异 点 处 则 
在 任务 空间 的 某 些 方向 上 丧失 了 活动 能 力 。 

一 种 更 直接 的 描述 与 奇异 位 形 的 距离 的 指标 是 雅 
AY EREE BARS, g 

O min = On 

最 小 奇异 值 可 以 通过 计算 量 较 小 的 方法 进行 估 
F, 包括 数值 方法 "1 或 基于 机 器 人 结构 运动 学 
分 析 的 方法 中 。 

必须 注意 ， 条 件数 或 了 的 最 小 奇异 值 差别 很 大 
的 时 候 ， 可 操作 性 指标 却 可 能 保持 不 变 。 另 一 方面 ， 
因为 在 奇异 点 附近 最 小 奇异 值 的 变化 比 其 他 奇异 值 更 
快 ， 它 会 对 雅 可 比 矩 阵 行列 式 和 条 件数 的 变化 起 主导 
作用 。 因 此 ， 描 述 到 奇异 位 形 距离 的 最 有 效 指标 就 是 
J, OB baw! 。 


11.3 微分 逆 运 动 学 


为 完成 一 项 任务 ， 必 须 控制 机 械 辟 关节 作 适 当 的 
运动 。 因 此 ， 推 导出 可 根据 给 定 的 任务 空间 量 计算 出 
关节 空间 量 的 数学 关系 非常 必要 。 这 也 正 是 道 运动 学 
问题 研究 的 目标 。 

逆 运 动 学 问题 可 以 通过 正 运动 学 方程 (11. 1)， 
一 阶 微分 运动 学 (11.2) 或 二 阶 微分 运动 学 方程 
(11.8) 求 逆 来 求解 。 如 果 任 务 是 时 变 的 ( 即 如 果 给 
ETERA G) 的 期 望 轨迹 )， 则 因为 微分 运动 学 
关系 表示 为 以 任务 雅 可 比 为 系数 矩阵 的 线性 方程 组 ， 
可 以 方便 地 求解 ”1。 


11.3.1 通 解 


假设 机 械 辟 是 运动 学 元 余 的 ( 即 M<N), È 
(11.2) 或 式 (11.8) 的 通 解 可 以 借助 任务 雅 可 比 挫 
Raat 工 来 表示 下， 伪 逆 是 指 满足 如 下 Moore- 


Penrose 条 件 的 唯一 矩阵 
JJJ =J, 
JIJ =J 
I) =I F 
(JJ) =J], 
WR J SEK Tr EEFE, MEAT hF 
计算 


(11.10) 


Ji =J (JJ (11.11) 
WRJ 是 方 阵 ,， 式 (11.11) EKERN RERE. 
式 (11.2) 的 通 解 可 以 写 为 
q =J't +(U-J'I.) @& (11. 12) 
式 中 , I~ SSE J, BAST PAVE SERRA; gy 是 -个 任 
意 的 关节 空间 速度 。 因 此 解 的 第 二 部 分 是 一 个 零 空 间 
速度 。 式 〈11. 12) 给 出 了 满足 末端 执行 器 任务 约束 
(11.2) 的 所 有 最 小 二 乘 解 ， 即 最 小 化 上 7 -Jg | 的 
fo TRAJ, 是 满 秩 长 方 矩 阵 时 ， 式 (11. 12) 表示 
的 所 有 关节 速度 都 能 正确 实现 给 定 的 任务 速度 。 通 过 
调节 gg ， 还 可 以 得 到 能 产生 相同 末端 执行 器 任务 速 
度 的 不 同 关 节 速 度 。 因 此 ， 就 像 后 面 将 详细 讨论 的 那 
样 ， 元 余 度 求解 的 相关 文献 一 般 都 采用 式 〈11. 12) 
形式 的 解 。 
在 式 (11.12) H, $ go =0 可 以 得 到 特 解 
q=Ji (11.13) 
该 特 解 是 式 (11.2) 的 最 小 范 数 的 最 小 二 乘 解 ， 
被 称 为 伪 道 解 。 对 于 逆 微 分 运动 学 问题 ， 最 小 二 乘 特 
性 保证 了 末端 执行 器 任务 实现 的 精度 ， 而 最 小 范 数 可 
能 与 关节 空间 速度 的 可 行 性 相关 。 
对 于 二 阶 运动 学 方程 (11.8), 它 的 最 小 二 乘 解 
可 以 表示 为 如 下 的 一 般 形式 
g =F t -J.q)+U-SJ,) aq, (11.14) 
式 中 ，gqo 是 一 个 任意 的 关节 空间 加 速度 。 如 上 所 述 ， 
在 式 〈11. 14) 中 , $ go =0 可 以 得 到 最 小 范 数 加 速 
度 解 
q =J'(t -Jq) 
奇异 点 的 鲁 棒 性 
现在 来 研究 一 阶 逆 映射 (11.12) 和 (11.13) 
与 奇异 点 处 理 所 涉 及 的 运动 学 方面 的 问题 。 参 考 式 
(11.9) BY, 的 奇异 值 分 解 ， 考 虑 矩阵 太 的 以 下 分 解 
J = VSU" = D oa; 


i=l 


AP, R Fea ERA ES HE OT ERE BE, AAD 


(11. 15) 


11.3.2 


(11. 16) 
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式 (11.9), AUTAT: 
T Z0, > BOR > OR, = =O 
IAT.) =A (J,) =span{ v, ve} 
AXT) = BS) =span| Ug, , ply] 

WES, WREN HEER, 二 的 值 空间 是 
R” 中 的 一 个 MH 维 子 空间 ,的 零 空 间 是 空 的 。 而 在 
奇异 位 形 处 (R < MM) ,十 的 值 空间 是 RR” 中 的 一 个 R 
维 子 空间 ，J 儿 存在 一 个 M-R 维 的 零 空 间 。 

的 值 空间 是 关节 空间 速度 9g 的 一 个 集合 ， 可 
以 根据 所 有 可 能 的 任务 速度 { ， 由 逆 运 动 学 映射 
(11.13) 计算 得 到 。 因 为 这 些 g 属于 J 的 零 空间 的 
正 交 补 ， 正 如 所 希望 的 奢 样 ， 伪 逆 解 (11. 13) 满足 
最 小 二 乘 条 件 。 

天 的 零 空 间 是 一 个 在 当前 位 形 产生 零 关 节 空 间 速 
度 的 任务 速度 上 的 集合 。 另 一 方面 ， 这 些 t 属于 可 
达 任 务 速度 空间 的 正 交 补 。 因 此 ， 伪 送 解 (11. 13 ) 
的 一 个 效果 是 滤 除 任务 速度 指令 中 不 可 实现 的 分 量 ， 
而 留 下 可 精确 跟踪 的 可 达 分 量 ， 这 是 和 伪 逆 解 的 最 小 
范 数 最 小 二 乘 特性 相关 联 的 。 

如 果 给 定 的 任务 速度 是 沿 着 a 方向 的 ， 则 相应 
的 关节 空间 速度 (由 式 (11.13) 计算 得 到 的 ) 平 
行 于 v,， 并 且 长 度 乘 以 系数 lo。 接近 奇异 点 时 ， 
第 RR 个 奇异 值 趋 于 零 ，un 方向 一 定 大 小 的 任务 速度 
所 需要 的 v4 方向 的 关节 空间 速度 大 小 与 系数 1/05 
成 比例 ， 将 无 限 增 大 。 处 于 奇异 点 时 ，ur Fy Tal MT FE 
务 变量 来 说 不 可 实现 ，w 成 了 机 械 臂 的 零 空 间 速 度 
之 一 。 

由 以 上 分 析 可 知 ， 有 两 个 主要 问题 与 基本 的 微分 
道 运 动 学 解 (11. 13) 有 着 本 质 上 的 联系 ， 即 : 

1) 接近 奇异 位 形 时 ， 可 能 需要 超大 的 关节 空间 
速度 ,原因 是 t 的 一 些 分 量 处 于 这 样 的 方向 上 ， 即 
在 奇异 点 处 不 可 实现 的 方向 。 


2) 处 于 奇异 位 形 时 ， 如 果 E 包含 非 零 的 不 可 达 
量 ， 则 关节 空间 解 将 不 存在 。 

这 两 点 对 于 完整 的 道 解 (11.12) 显然 也 是 一 
样 的 。 

上 述 两 个 问题 都 是 机 械 壁 运动 学 控制 主要 关心 的 
问题 ， 控 制 中 要 求 计 算出 的 关节 空间 速度 必须 是 机 带 
人 手臂 能 够 实际 实现 的 才 行 。 针 对 上 述 问 题 ， 发 展 出 
了 改进 的 微分 逆 映 射 ， 以 确保 机 械 辟 在 整个 工作 空间 
中 行为 适当 。 一 种 合理 的 方法 是 远离 奇异 点 时 仍然 使 
用 映射 (11. 13) ， 只 在 奇异 位 形 附 近 的 区 域内 对 该 
映射 进行 改动 。 区 域 的 定义 则 要 靠 描 述 到 奇异 点 距离 
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的 适当 指标 来 实现 ， 而 且 改 进 的 映射 必须 保证 关节 速 
度 是 连续 的 和 可 实现 的 。 

1. 规划 轨迹 修正 

处 理 奇异 点 问题 的 一 种 方法 是 在 规划 阶段 就 让 轨 
迹 避 开 无 法 消除 的 奇异 点 ， 或 者 说 只 赋 给 机 器 人 手臂 
可 实现 的 任务 空间 运动 指令 。 然 而 ， 这 种 方法 依赖 于 
理想 的 轨迹 规划 ， 无 法 在 实时 的 传 感 控制 中 应 用 ， 因 
为 实时 控制 时 运动 指令 是 在 线 生 成 的 。 

对 于 任务 空间 中 国定 的 奇异 点 ， 比 如 类 人 手 
壁 的 肩 部 奇异 ， 在 运动 规划 阶段 避 开 奇异 位 形 相 
对 简单 。 但 是 ， 对 于 那些 有 可 能 在 工作 空间 的 任 
何 地 方 出 现 的 奇异 ， 比 如 腕 部 奇异 ， 这 种 方法 就 
难以 实现 。 

解决 奇异 问题 的 另 一 种 可 能 的 方法 是 当 机 械 臂 接 
近 奇 异 点 时 进行 关节 空间 插值 。 不 过 ， 这 种 方 
法 有 可 能 在 跟踪 之 前 指定 的 任务 空间 运动 时 产生 很 大 
的 误差 。 

参考 文献 11.5] 提出 了 一 种 作用 在 任务 空间 
的 、 基 于 时 间 尺 度 变换 的 方法 。 这 种 方法 令 机 械 辟 在 
接近 奇异 点 时 降低 运动 速度 。 但 当 机 器 人 处 于 奇异 抬 
时 ， 这 种 方法 就 失效 了 。 

因为 基于 任务 空间 的 机 器 人 控制 系统 必须 能 控制 
机 械 臂 安全 地 通过 奇异 点 ， 大 量 研究 转身 了 推导 和 定义 
明确 的 连续 的 道 运动 学 映射 。 

2. 消除 雅 可 比 和 矩阵 中 线性 相关 的 行 / 列 

求解 式 (11.13) 首先 要 求 当 雅 可 比 奇 异 时 ， 
计算 J 的 伪 逆 的 一 般 算法 是 有 效 的 。 文 献 中 提出 了 
一 些 算法 属于 这 样 一 种 模式 ， 消 除 不 可 实现 的 末端 
参考 运动 分 量 ”“: ， 或 是 使 用 雅 可 比 矩 阵 的 非 奇异 
Ay ye Ol 。 这 类 方法 的 主要 问题 是 要 用 一 种 系统 性 
的 方法 求 出 不 可 达 速 度 的 方向 ， 以 及 需要 在 常规 的 
和 用 于 奇异 点 附近 的 道 运 动 学 算法 之 间 进 行 平滑 
切换 。 

一 种 计算 雅 可 比 矩 阵 伪 逆 的 系统 性 方法 可 以 
利用 对 机 械 辟 结构 的 运动 学 分 析 来 建立 ， 因 为 对 
于 典型 的 机 械 臂 ， 有 可 能 在 适当 地 与 连 杆 固 接 的 
动 坐标 系 中 辨识 和 描述 奇异 位 形 的 类 别 。 参 考 文 
献 (11.17, 18] 针对 六 自由 度 肘 关节 形式 的 机 械 
璧 描述 了 这 种 方法 。 

要 在 穿越 奇异 点 时 保持 解 的 连贯 性 ， 需 要 注意 的 
是 ， 机 械 臂 在 奇异 点 附近 时 奇异 向 量变 化 非常 小 ， 但 


在 奇异 位 形 处 时 R 变 得 比 Mh, vu 项 突然 从 
M 


xh (11.16) 中 消失 了 。 
一 种 可 能 的 避免 这 一 问题 的 方法 是 在 奇异 点 附近 
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Qurt =0， 这 意味 着 去 除 奇异 时 不 可 达 的 方向 上 的 
任务 速度 指令 。 不 过 ， 如 11.3.2 节 所 述 ， 这 种 方法 
只 有 在 针对 任务 空间 中 固定 的 奇异 点 的 轨迹 预先 规划 
时 ， 才 可 以 合理 运用 。 


无 论 给 定 的 上 是 什么 ， 伪 道 解 的 连贯 性 都 可 以 
这 样 来 确保 : 在 适当 定义 的 奇异 点 邻 域内 将 机 械 臂 视 
为 奇异 ， 将 雅 可 比 修改 为 J ， 因 而 可 得 MR 个 额外 
的 自由 度 “ ”2 。 这 不 会 对 末端 执行 器 速度 有 太 大 
影响 ， 因 为 修正 的 雅 可 比 J 在 领域 内 趋 近 于 J。 当然 
这 种 方法 难以 用 于 多 重 奇 异 点 。 但 对 于 上 典型 的 类 人 结 
MM TVS, 需要 主要 关心 的 只 有 腕 部 奇异 ， 因 
为 腕 部 奇异 可 能 在 工作 空间 的 任何 地 方 出 现 ， 而 肘 部 
和 肩 部 奇异 在 任务 空间 中 是 固定 的 ， 因 而 可 以 通过 规 
划 来 避 开 。 
3. 正则 化 /阻尼 最 小 二 乘法 
参考 文献 [11.9, 20] 各 自 独立 地 提出 了 将 阻 
尼 最 小 二 有 蒋 法 用 于 微分 逆 运 动 学 问题 的 方法 。 这 种 方 
法 相当 于 求解 方程 
Jéia=(SI+VDG (11.17) 
MAZE (11.2), RP, AcR 为 阻尼 系数 。 可 以 
验证 ， 当 和 为 零 时 ， 式 (11.17) 和 式 (11.2) 就 是 
一 样 的 了 。 
A (11.17) 的 解 可 以 写 为 两 种 等 价 的 形式 : 
q = 万 (JI +AT)t (11.18) 
q = (TT +ATD Ti (11. 19) 
式 (11.18) 的 计算 量 小 于 式 (11.19) 的 ， 因 
为 一 般 而 言 Y=M。 下 文 在 不 需要 显 性 描述 计算 过 程 
的 地 方 ， 将 把 阻尼 最 小 二 乘 解 归 结 为 
q =J (qi 
解 式 (11.20) 满足 以 下 条 件 
min=( [lt -Jg |È +a? Ilg IP) 
该 条 件 实现 了 最 小 二 乘 特 性 和 最 小 范 数 特性 的 折 中 。 


条 件 (11.21) 意味 着 在 求 给 定 所 需要 的 关节 空间 
速度 时 ， 同 时 考虑 精度 和 可 实现 性 。 在 这 点 上 ， 适 当 
选择 阻尼 系数 非常 关键 : 较 小 的 A 值 能 给 出 精确 解 ， 
但 对 奇异 点 和 近 奇 异 点 位 形 的 鲁 棒 性 较 差 ， 较 大 的 A 
值 会 导致 跟踪 精度 较 低 ， 即 使 是 在 精确 可 行 解 可 能 存 
的 时 候 。 

按照 奇异 值 分 解 的 模式 ， 解 (11.20) 可 以 写 为 


(11. 20) 


(11.21) 


一 (11. 22) 





4 = 2) a> 


请 注意 ， 下 式 成 立 


WI) = RT) =H (J,) =span{v,, 9] ; 

MN) SAIO =R (J,) =spanla uy} 

类 似 于 卫 ， 如 果 雅 可 比 和 矩阵 满 秩 ,J 的 值 空间 
ÆR 中 的 M 维 子 空间 ， 并且 的 零 空间 是 空 的 ， 
而 在 奇异 位 形 处 ，J* BESEER” 中 的 RETA 
则 ， 并 且 存 在 一 个 M-R 维 的 零 空间 。 

显然 ， 相 比 于 纯粹 的 最 小 二 乘 解 (11.13)， 解 
(11.22) 中 满足 o; >> A 的 部 分 受阻 尼 系 数 的 影响 较 
小 ， 因 为 此 时 有 


T; 1 





o? +A? O; 

ATi, SBAGHRAM, mhi RAF 
零 ， 而 解 的 相关 部 分 被 系数 o,/X? 强 制 为 零 ， 这 就 逐 
渐 减少 了 为 实现 期 望 上 中 接近 退化 的 部 分 所 需 的 关 
六 速度 。 在 奇异 点 ， 只 要 剩余 奇异 值 比 阻尼 系数 大 得 
多 , f (11.20) 和 解 (11.13) 的 行为 就 是 一 致 的 。 
请 注意 ， 归 因 于 阻尼 系数 ，1/(2A) 的 上 界 依赖 于 -- 
个 增益 系数 ， 第 i 个 系数 是 wu 方向 的 任务 速度 分 量 和 
它 产 生 的 w 方 向 关节 速度 之 间 的 系数 ; 当 o, =A 时， 
达到 该 上 界 。 

(1) 阻尼 系数 选取 ”由 上 所 述 ， 选 取 的 阻尼 系 
数值 给 定 了 当前 位 形 与 奇异 点 的 接近 程度 ;而 且 ，A》 
决定 了 与 伪 逆 给 出 的 纯 最 小 二 乘 解 的 相似 程度 。A 的 
优化 选取 需要 考虑 给 定 轨迹 上 的 最 小 非 零 奇异 值 ， 并 
考虑 确保 可 实现 关节 速度 的 最 小 阻尼 。 

为 了 在 机 械 臂 的 整个 工作 空间 中 实现 出 良好 的 
性 能 ， 参 考 文献 [11.9] 提出 让 阻尼 系数 随 位 形变 

。 普 通 的 方法 是 把 A 作为 机 器 人 手臂 当前 位 形 到 
奇异 点 距离 的 一 个 函数 来 调节 。 远 离奇 异 位 形 时 解 
出 的 关节 速度 是 可 达 的 ; 因此 精度 要 求 占 主导 ， 应 
使 用 较 小 的 阻尼 。 接 近 奇 异 点 时 ， 不 可 达 方 向 的 任 
务 速度 指令 将 导出 很 大 的 关节 速度 ， 因 此 精度 要 
求 应 该 放松 ; 在 这 种 情况 下 ,需要 使 用 较 大 的 
SHE o 

参考 文献 [11.9] 提出 把 阻尼 系数 当成 可 操作 
性 指标 的 函数 来 调节 。 因 为 雅 可 比 答 阵 的 最 小 奇异 值 
是 描述 到 奇异 点 位 形 距离 更 有 效 的 指标 [11.5], F 
文 将 考虑 用 它 来 构造 可 变 的 阻尼 系数 。 

如 果 能 得 到 最 小 奇异 值 的 估计 值 Gu, BEAM 
Ay eA FRN 





， 0 4 oyze 时 
° BERAS 其 他 
(11. 23) 
上 上述 阻尼 系数 能 确保 解 的 连续 性 和 和 良好 形态 。 在 式 
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(11.23) 中 ,= 定义 了 奇异 区 域 的 大 小 ， 在 此 区 域内 
施加 阻尼 ; A, 则 设 定 了 阻尼 系数 的 最 大 值 ， 在 奇异 
点 处 取得 该 值 。 

(2) 数字 滤波 BA (11.22) 可 知 ， 阻 尼 系 数 
在 所 有 末端 执行 器 速度 分 量 上 都 影响 解 的 精度 ， 但 其 
实 末端 执行 器 速度 只 有 在 不 可 达 方 向 上 的 分 量 才 导致 
跟踪 能 力 的 损失 。 为 了 克服 这 个 问题 ， 参 考 文献 
[11.6] 提出 了 对 末端 执行 器 速度 分 量 进行 选择 性 滤 
波 的 方法 。 方 法 可 如 下 推导 : 如 果 可 以 得 到 输出 奇异 
向 量 的 一 个 估计 在 ， 此 处 的 输出 奇异 向 量 是 与 形成 不 
可 达 分 量 的 最 小 的 M-K 个 奇异 值 相关 的 ， 解 就 可 以 
写 为 如 下 形式 

qg =J JI, + AT+P: Y aa) “lf (11.24) 

式 中 , 6 只 沿 着 不 可 达 分 量 方向 给 出 阻尼 的 最 大 分 

量 。 这 也 可 以 由 下 式 来 验证 

q = 之 oe geht + 之 EEU =) pet 

(11.25) 

其 中 的 近似 是 因为 式 (11.24) 使 用 的 是 估计 值 i. 

请 注意 KR; 但 哪怕 输出 奇异 向量 的 估计 不 正确 ，A 入 
也 要 保持 非 零 值 以 保证 满足 映射 (11.24) 的 条 件 。 

同样 地 ， 对 于 由 与 最 小 奇异 值 相 关 的 输 和 人 奇异 向 
量 生成 的 关节 速度 分 量 ， 可 以 施加 附加 的 阻尼 。 因 为 
这 样 的 速度 分 量 接近 于 有 堆 空 间 速 度 ” 。 解 的 一 般 
形式 为 


N 
4 = (J +I +e Y G) Jit (11.26) 
i=k+l 


式 中 ，B 只 沿 着 NK 个 零 空间 速度 分 量 的 估计 值 ye 
出 阻尼 的 最 大 分 量 。 这 也 可 以 由 下 式 来 验证 
。 £ O; Ti 2 i tT: 
q = 之 ae - aa 十 2 FA TB xe pee 


(11.27) 


其 中 的 近似 也 是 因为 式 (11.26) 使 用 了 估计 值 %。 
同样 ， 在 这 种 情况 下 ， 即 使 输入 奇异 向 量 的 估计 不 正 
a, A 也 要 保持 非 零 值 以 保证 满足 映射 (11.26) 的 
条 件 。 

对 比 式 〈11.27) 和 式 (11.25) 可 以 看 出 ,在 
奇异 向 量 估计 精确 的 情况 下 , 解 (11.24) 和 解 
(11.26) 相等 。 


11.3.3 关节 轨迹 重 构 
在 求解 一 阶 微分 道 运动 学 时 ， 可 得 到 与 给 定 的 末 
端 执行 器 任务 速度 曲线 t (1) 相应 的 关节 速度 曲线 





q(t), 但是， 机 器 人 运动 控制 器 除了 参考 关节 速度 
还 需要 参考 位 置 轨迹 。 根 据 由 末端 执行 器 速度 曲线 


f(t) 得 到 的 关节 速度 曲线 重 构 出 关节 位 置 曲线 ， 就 
实现 了 运动 学 求 道 ， 这 可 以 看 成 是 一 种 道 运动 学 
算法 。 

如 果 关 节 速 度 曲 线 完全 确定 (比如 通过 它 的 解 
析 式 确定 ) ， 相 应 的 关节 位 置 曲线 可 以 通过 对 时 间 积 
分 来 得 到 ， 即 


a(t) = a(t) + {GDdr (11.28) 


不 过 ， 机 器 人 控制 系统 的 数字 化 实现 使 得 得 到 关 
节 速 度 的 离散 序列 g EARE, qA 时刻 对 计算 
得 到 的 关节 速度 的 采样 ， 即 

q = 4 (t,) 

由 于 这 一 原因 ， 必 须 提出 连续 时 间 积 分 (11. 28) 
的 离散 时 间 近 似 方法 。 

连续 时 间 积 分 准确 的 离散 时 间 近 似 通 常 需要 在 插 
值 算法 的 复杂 性 和 时 间 步 长 之 间 进 行 折 中 。 在 实时 应 
用 场合 ， 比 如 机 器 人 运动 控制 ， 高 阶 插值 会 造成 大 的 
时 延 ， 降 低 控制 回路 的 动态 性 能 。 这 种 时 延 可 以 通过 
适当 缩短 时 间 步 长 来 减少 。 无 论 如何 ， 如 果 低 阶 插 值 
也 能 得 到 可 以 接受 的 数字 积分 精度 ， 时 间 步 长 也 就 足 
够 得了 。 典 型 的 情况 是 一 阶 播 值 ， 比 如 欧 拉 前 向 积分 
法 把 积分 (11.28) 转化 为 


k-1 
de = % + X qA (11. 29) 
A=0 


式 中 ，At 是 时 间 步 长 。 方程 (11.29) 一 般 写 为 更 有 
效率 的 递 推 形式 
di =9 -1 +Q- Ât 

不 论 使 用 哪 种 插值 法 ,每 一 步 数值 积分 都 存在 虽 
然 很 小 但 却 避 免不了 的 误差 ， 误 差 还 会 累积 ， 导 致 重 
构 曲 线 与 精确 的 关节 位 置 曲线 之 间 的 长 期 漂移 。 影 响 
所 有 积分 重 构 方 法 的 男 一 个 误差 源 是 关节 位 置 初始 值 
可 能 有 误差 。 

克服 这 些 问题 的 计算 方法 基于 反馈 修正 项 的 使 
用 ,被 称 为 闭环 逆 运 动 学 (CLIK: closed-loop inverse 
kinematics) 。 例 如 一 阶 运动 学 的 情况 , 天 时 刻 关 节 速 
度 可 由 下 式 计 算 (对 比 式 (11. 12)) 


q =J (q) lft. + Kt, -k (q,)]} + (11.30) 
[¥-JiCa.) J.C) ] gu 


AH, 天 是 一 个 正定 常数 增益 矩阵 。 
二 阶 CLIK 算法 也 能 用 于 求解 关节 人 位置、 速度 和 
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We BE). CLIK 算法 最 初 是 在 参考 文献 
[11.26] 和 [11.27] 中 提出 的 , 方法 用 雅 可 比 的 转 
置 代 蔡 了 伪 逆 ,这 可 以 显著 减少 计算 量 并 可 用 于 固有 
奇异 点 3] 。 


11.4 元 余 度 求解 的 优化 法 


对 于 运动 学 元 余 的 机 械 臂 ， 逆 运动 学 问题 可 以 有 
无 穷 多 解 ， 因 此 需要 一 个 对 解 进行 选择 的 指标 。 本 节 
考虑 在 一 阶 微分 运动 学 层次 上 的 元 余 度 求解 的 优化 
法 。 在 讨论 关节 速度 计算 的 算法 性 策略 之 前 ， 先 简单 
回 熙 一 下 可 能 的 性 能 指标 。 


11.4.1 性 能 指标 


具有 上 比 完成 给 定 任务 所 需 自由 度 更 多 的 自由 度 的 
能 力 ， 可 以 用 于 在 运动 过 程 中 提高 性 能 指标 。 这 样 的 
8 标 可 能 只 依赖 于 机 器 人 关节 位 形 ， 或 者 还 与 速度 或 
加 速度 有 关 。 

在 能 够 通过 定义 适当 指标 来 追求 的 附加 目标 中 ， 
最 重要 的 可 能 是 避 奇 异 。 实 际 上 ， 引 人 运动 学 宛 余 
的 一 个 主要 原因 就 是 要 减少 工作 空间 中 ,机 械 臂 必 
须 处 于 奇异 位 形 才能 达到 的 区 域 ， 这 样 的 奇异 位 形 
被 称 为 不 可 避 奇 异 点 。 宛 余 机 械 辟 中 的 可 避 和 不 可 
避 奇 异 点 的 讨论 可 参见 参考 文献 【11. 29 ] 。 如 果 给 
定 的 末端 执行 器 任务 不 经 过 不 可 避 奇 异 点 ， 原 则 上 
总 是 有 可 能 算出 一 条 关节 轨迹 ,任务 雅 可 比 J, 沿 着 
这 条 轨迹 是 连续 满 秩 的 。 为 实现 这 一 目标 ， 可 能 的 
性 能 指标 就 是 11. 2. 2 节 介 绍 的 描述 到 奇异 点 距离 的 
那些 独立 于 位 形 的 函数 ， 即 可 操作 性 、 条 件数 和 
的 最 小 奇异 值 。 在 运动 过 程 中 使 这 些 函 数 最 大 化 
〈 或 保持 尽 可 能 大 的 值 ) 是 在 运动 中 避 开 奇异 位 形 
的 合理 方案 。 

因为 运动 学 求 逆 在 奇异 位 形 的 邻 域内 会 产生 趋 于 
无 穷 大 的 关节 速度 ， 一 种 概念 上 有 所 不 同 的 方法 就 是 
最 小 化 元 余 度 求解 所 生成 的 关节 速度 的 范 数 。 不 过 ， 
只 有 当 该 范 数 在 机 械 臂 的 所 有 运动 中 都 最 小 化 时 ， 这 
种 方法 才能 保证 避 开 奇异 点 。 范 数 的 局 部 极 小 2: 
对 于 避 奇 异 没 有 任何 实际 意义 入  。 

元 余 度 还 可 以 用 于 使 机 械 臂 连 杆 机 构 避 开 一 些 不 
受 欢迎 的 关节 空间 ， 比 如 机 械 性 的 关节 限制 ， 这 是 机 
请 人 机 械 臂 典型 存在 的 ， 可 以 通过 最 小 化 如 下 代价 函 
BOR RF 

qi; mid 
nie) 


H(g) = 7 


AP, [imino Gismex 是 关 闻 i 的 有 效 活动 范围 ; 


iM = 


i 
2 
] 


qi 是 该 范围 的 中 点 。 壁 障 是 宛 余 度 的 另 一 项 有 意思 
的 应 用 ， 它 可 以 通过 最 小 化 适当 的 人 工 势 场 来 实现 ， 
人 工 势 场 函数 基于 障碍 区 域 在 位 形 空间 中 的 投影 来 
定义 i 31 32] 

文献 中 还 提出 了 很 多 其 他 的 性 能 指标 ， 其 中 一 些 
将 在 11.6 节 和 11.9 节 中 提 到 。 


11.4.2 局 部 优化 


局 部 优化 的 最 简单 形式 可 以 用 伪 道 解 (11.13) 
来 表示 。 它 给 出 了 满足 任务 约束 的 关节 速度 中 范 数 最 
小 的 那个 。 显 然 ， 由 局 部 最 优 解 生成 的 关节 运动 不 是 
机 械 臂 所 有 可 能 的 运动 中 速度 最 小 的 。 这 意味 着 ， 尽 
管 局 部 最 小 化 了 关节 速度 ,还 是 不 能 确保 避 开 
奇异 [3] | 

使 用 通 解 (11. 12) 的 另 一 种 可 能 方法 是 选取 需 
要 最 小 化 的 性 能 指标 有 H(qg)， 在 它 的 反 梯 度 方向 上 选 
取 任 意 的 关节 速度 qo: 

lo = ~kyV H(q) (11.31) 

AF, krei Kip; V H(g) 28 WOE SBT 
关节 位 形 的 梯度 。 这 种 方法 可 引出 下 面 的 宛 余 度 求解 
方法 [30] 





q = 大 -ky-JJ,.)VA(q) (11.32) 

因为 式 (11.32) 的 第 二 项 是 五 的 反 梯 度 在 雅 可 
比 算 阵 零 空 间 中 的 投影 ， 上 式 让 人 想起 了 约束 最 小 化 
问题 中 的 梯度 投影 法 号 3。 尤其 是 参考 文献 
[11.34] 显示 ， 逆 运动 学 解 (11.32) 在 当前 位 形 q 
处 ， 最 小 化 了 完全 二 次 方程 

La, d) =3-4"@ -kug 'VH(q) 

因此 , 式 (11.32) 代表 了 性 能 指标 五 的 无 约束 局 
部 最 小 化 (这 将 导致 选取 g = -hyY H(q))， 和 通过 最 
小 范 数 关节 速度 来 满足 约束 (11.2) 之 间 的 折 中 。 

PR 的 选择 对 于 元 余 度 求解 算法 (11.32) 的 
性 能 非常 关键 。 特 别 是 ， 较 小 的 步 长 值 可 能 降低 性 能 
指标 最 小 化 的 速度 ,但 男 一 方面 ， 较 大 的 值 其 至 可 能 
FRA RWS (回想 一 下 ， 反 梯度 只 是 局 部 的 最 
快 下 降 方向 ) 。 实 际 上 ， 要 为 每 个 位 形 在 适当 的 时 间 
内 确定 一 个 好 值 ， 可 以 使 用 简化 的 线 搜索 技术 ， 比 
如 Armijo My" 。 


11.4.3 全 局 优化 


元 余 度 解法 (11.32) 的 主要 优点 是 简单 : 如 果 
V H(q) 和 所 的 计算 是 有 效率 的 ， 它 就 是 实时 运动 
学 求 逆 可 以 实际 采用 的 一 种 方法 。 它 的 缺点 在 于 优化 


过 程 的 局 部 性 ， 这 可 能 在 较 长 时 间 的 任务 中 造成 不 令 
人 满意 的 性 能 ， 比 如 ， 使 用 式 (11.32) whe A = 
-u CERME) 将 比 简单 的 伪 逆 解 表现 更 好 ， 但 还 
是 不 能 保证 避 开 奇异 。 

因此 很 自然 地 会 去 考虑 在 式 〈11. 12) 中 对 Goi 
行 选择 ， 以 便 最 小 化 积分 指标 | Hq) di 的 可 能 性 。 


该 指标 定义 在 整个 任务 的 时 间 域 [i, tt] 上 
(比如 随 着 运动 对 可 操作 性 积分 ) 。 不 香 的 是 ， 这 
个 问题 的 解 (自然 地 会 表示 为 变 分 形式 的 式 子 ) 
可 能 不 存在 ， 并 自在 任何 情况 下 ,通常 都 没有 封 
闭 形式 。 值 得 注意 的 是 ， 使 该 问题 必然 可 解 的 一 
种 方法 是 在 积分 中 加 入 关节 速度 或 加 速度 的 二 次 
齐 式 。 不 过 ， 这 在 二 阶 运 动 学 层面 上 更 容易 实现 
(参见 11.6 节 )。 


11.5 元 余 度 求解 的 任务 增 广 法 


另 一 种 元 余 度 求解 的 方法 是 增 广 任务 向 量 以 便 处 
理 表示 为 约束 的 附加 目标 。 在 本 节 中 ， 将 回顾 用 于 求 
解 一 阶 微分 运动 学 方程 (11.2) 的 基本 的 任务 增 广 
技术 。 
11.5.1 扩展 雅 可 比 和 矩阵 


扩展 雅 可 比 技术 是 由 Baillieali 5 提出 、 并 在 
后 来 由 Chang"'" “再 次 提出 的 。 这 种 方法 在 原始 的 
末端 执行 器 任务 上 添加 适当 数量 的 函数 约束 ， 从 而 
可 以 在 满足 末端 执行 器 任务 的 无 穷 多 解 中 得 出 确定 
的 一 个 。 

考虑 一 个 优化 的 目标 函数 gg)， 并 令 Nj Ca) 
为 在 非 奇异 位 形 q 处 张 成 了 的 零 空 间 的 和 矩阵， 比如 ， 

N, =1-JJ, 

可 以 验证 ， 对 于 一 个 给 定 的 to, WMR qo 是 这 样 
一 个 位 形 ， 它 使 函数 g(q) EAR h =k g) 之 下 
取得 极 值 ， 则 有 


deta) N; (Go) =0' 
3g eae 


如 果 雅 可 比 J, 满 秩 ， 秩 为 M, TWN, 的 秩 为 N- MW。 
因此 , 方程 (11.33) 生成 一 组 独立 的 和 -MH 个 约束 ， 
可 写 为 如 下 向 量 形式 

h(q) =0 
比如 ， 可 以 通过 逐个 求 梯度 3g(g)/69g 与 N-M 个 向 量 
的 标量 积 来 得 到 ， 而 这 N- M 个 向 量 是 了 零 空间 的 一 
个 基底 ， 即 


(11.33) 


EII 25- 


heg) = (Dv Cana) 
在 这 一 点 上 ， 条 件 〔11.33) 意味 着 满足 方 和 
klgo)\ /to 
(car) lo) 
对 于 以 4 和 位 姿 g 为 起 始点 的 运动 ， 通 过 在 每 
个 时 刻 都 令 g(g) 取 极 值 来 跟踪 轨迹 {(?) 的 运动 


则 有 
(人 
h(q(t)) 0 
两 边 同 时 对 时 间 求 导 可 得 
J (aa) i 
Coad 
oq 
AP, ARAE qg HEREDE, RAD IRE 
HJ HE J FE 


因此 ， 如 果 初 始 位 形 g Egla) 取得 极 值 ， 并 
假设 J 不 会 奇异 ， 则 北上 映射 


q “Jao 4] 
0 
的 时 间 积 分 可 生成 使 g(g) 取 极 值 的 关节 位 形 ， 从 而 
跟踪 给 定 的 某 端 执行 器 轨迹 t (1)。 
扩展 雅 可 比方 法 相 比 于 式 (11. 13) 形式 的 伪 逆 
法 有 一 个 主要 的 优点 就 是 它 是 循环 的 〈( 见 11.7 市 )。 


此 外 ， 通 过 适当 选取 向 量 qo, 解 (11.35) 就 可 等 价 
于 解 (11. 12) 0137 。 


11.5.2 增 广 牙 可比 和 矩阵 


另 一 种 方法 ， 即 所 请 的 任务 空间 增 广 法 ， 先 引入 
一 个 与 末端 执行 器 任务 一 起 执行 的 约束 任务 。 然 后 ， 
建立 一 个 增 广 雅 可 比 矩 阵 ， 由 它 的 道 给 出 搜索 到 的 关 
节 速 度 解 。 Seiavicco、 Siciliano >S] 和 Ege- 
land!" “0! 分别 独立 提出 了 任务 空间 增 广 的 概念 ， 随 后 
Seraji 又 在 位 形 控 制 法 的 架构 中 再 次 提出 这 一 
概念 1 。 

详细 来 说 ， 考 虑 向 量 上 = (t.1…t.p) ， 它 描述 
TEA M 维 末端 执 行 器 任务 上 一 起 执行 的 附加 任务 。 
虽然 完全 利用 宛 余 度 意 味 着 所 考虑 的 附加 任务 要 正好 
MEA AE HES, BD P=N-M, 一 般 情况 下 取 
PsN-M, 

关节 空间 坐标 向 量 4 和 约束 任务 向 量 t, 之 间 的 
关系 ,可 以 考虑 为 正 向 运动 学 方程 

t, =k, (q) 


(11.34) 


(11. 35) 


(11. 36) 
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其 中 是 一 个 连续 的 非 线 性 向 量 函数 。 
因此 ， 考 虑 如 下 映射 是 有 益 的 


t,=J.(q)q (11.37) 
该 映射 可 由 方程 (11.36) 微分 得 到 。 在 式 


(11.37) 中 ， 志 是 约束 任务 速度 向 量 ， 并 且 J (9) = 
Bk./9q Æ P x N HERI ARIES RETI EIERE, 

至 此 ， 增 广 任务 向 量 可 以 通过 拼接 未 端 执行 器 任 
务 向 量 和 约束 任务 向 量 定义 为 


ES) 
É k.(q) 

根据 这 一 定义 ， 寻找 使 取 某 些 期 望 值 的 关节 
位 形 9， 就 意味 着 同时 满足 未 端 执行 器 任务 和 约束 
任务 。 

这 个 问题 的 解 可 以 通过 在 微分 层面 上 反 求 下 面 的 
映射 关系 来 得 到 


t,. =J,(q)gq (11. 38) 
其 中 矩阵 
J, 
J = 
四 
被 称 为 增 广 雅 可 比 和 矩阵 。 


一 种 约束 任务 向 量 的 特殊 选择 是 二 =h(g)， 其 
F h RRE 11.5.1 节 中 所 描述 的 那样 定义 ， 这 就 可 
以 使 增 广 雅 可 比 法 包含 了 扩展 雅 可 比 法 。 


11.5.3 算法 性 奇异 


在 跟踪 末端 执行 器 之 外 定义 附加 目标 增加 了 这 
样 的 可 能 性 : 存在 使 增 广 运 动 学 问题 奇异 ， 而 单纯 
的 末端 执行 器 任务 运动 学 并 不 奇异 的 位 形 。 这 种 位 
PAM Ri SRR aR), 参见 速度 关系 式 
(11.34) 和 式 (11.38) ， 算 法 性 奇异 位 形 使 扩展 雅 
可 比 先 阵 和 增 广 雅 可 比 矩 阵 分 别 是 奇异 的 ， 而 了 却 
是 满 秩 的 。 

最 初 的 任务 增 广 宛 余 度 解法 提出 之 后 ，Baillieul 
指出 算法 性 奇异 点 不 是 扩展 雅 可 比方 法 特有 的 问题 ， 
但 扩展 雅 可 比 法 会 造成 约束 任务 与 末端 执行 器 任务 的 
冲突 ”1 。 这 在 简单 情况 下 很 容易 理解 ， 比 如 包 
含 避 障 问题 的 轨迹 跟踪 的 时 候 : 如 果 期 望 轨迹 经 过 一 
个 麻 碍 ， 那 就 要 么 跟踪 轨迹 ， 要 么 避 开 障碍 ， 两 个 目 
标 不 可 能 同时 实现 。 如 果 两 种 任务 之 间 的 冲突 来 源 有 
一 个 清晰 的 含义 ， 那 么 算法 性 奇异 就 有 可 能 根据 具体 
人 情况， 通过 机 敏 地 定制 约束 任务 来 避免 (例如 ， 参 
考 文献 [11. 23] )。 在 更 一 般 的 情况 下， 一 些 分 析 工 
其 可 能 在 寻找 算法 性 奇异 和 指导 约束 函数 的 选取 时 有 


Feed 或 在 寻找 更 好 地 调和 两 种 任务 的 位 形 时 
Ay Ft 3) 
考虑 式 〈11.2) MÈ (11.37) 定义 的 任务 ， 通 
过 考虑 它们 的 逆 映 射 可 以 看 到 当 有 
R (JENAR CI") 440} (11.39) 
时 ， 两 种 任务 是 冲突 的 ， 因 此 这 是 出 现 算法 性 奇异 的 
条 件 。 另 一 方面 ， 当 有 
R (IL) NH IT) = 10) 
时 ， 央 为 两 个 逆 映 射线 性 无 关 ， 两 种 任务 是 不 冲突 
的 。 有 一 种 任务 不 冲突 的 特殊 情况 是 
R (Jo) =H +H) 
并 且 两 个 映射 相互 正 交 。 
在 算法 性 奇异 点 处 ， 增 广 AE BY ELAR REN By at, 18 
可 以 采用 奇异 点 鲁 棒 技 术 。 因 为 不 存在 精确 解 ， 会 有 
重 构 误差 .而 且 这 对 两 种 任务 向 量 都 会 有 影响 。 要 抵 
消 这 个 问题 ， 参 考 文献 [11. 44，451 考虑 用 加 权 阻 
尼 最 小 二 乘法 来 对 增 广 雅 可 比 矩 阵 求 送 。 另 一 种 不 同 
的 方法 是 所 谓 的 任务 优先 级 道 运动 学 。 


11. 5.4 任务 优先 级 


在 任务 优先 级 策略 框架 下 ， 是 通过 给 期 望 任务 分 
配 适 当 的 优先 级 ， 然 后 只 在 高 优先 级 任务 的 零 空 间 中 
去 满足 低 优 先 级 任务 ， 来 处 理 末端 执行 器 任务 与 约束 
任务 之 间 的 冲突 ““” 。 典 型 情况 下 ， 末 端 执 行 器 
任务 被 认为 是 主要 任务 , 虽然 有 时 它 是 次 要 任 
务 “”。 该 方法 的 思想 是 当 精 确 解 不 存在 时 ， 重 构 
误差 只 会 影响 低 优先 级 的 任务 。 

参见 解 (11. 12) ， 任 务 优先 级 方法 计算 出 适当 
的 g。， 以 实现 P 维 的 约束 任务 i.。 值 得 注意 的 是 ， 
将 go 投影 到 J 的 零 空间 保证 了 约束 任务 比 末端 执行 
器 任务 的 优先 级 低 ， 因 为 投影 结果 是 一 个 零 空间 
速度 4] 


当 次 要 任务 t. 与 主要 任务 i EX ( 即 满足 方程 
(11.40)) 时 ,关节 速度 
qo =J'(q) i. (11.41) 
可 以 很 容易 地 解决 问题 ， 而 且 主 要 任务 速度 映射 式 
(11.2) 的 零 空 间 速 度 也 有 了 〈 即 不 需要 N, 的 投影 
项 了 ) 。 不 过 ， 通 常 两 类 任务 可 能 不 冲突 但 也 不 是 正 
交 的 ， 或 者 有 冲突 ， 不 存在 同时 实现 上 和 .的 关节 
速度 解 。 方 法 与 两 种 任务 所 定义 的 优先 顺序 相关 ，_- 
种 合理 的 选择 是 保证 精确 跟踪 主要 任务 速度 的 同时 ， 
最 小 化 约束 任务 速度 的 重 构 误差 i- Jg, K 
g2 p [11-49] 


(11. 40) 
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do [JA -JJA (t-J Jt) (11.42) 

RR, UVRUSSARBATERS RE 
阵 ， 所 以 式 (11.12) 和 式 (11.42) 的 解 可 以 简 
化 为 [14 

q =i +(J,U-FI) 1 C -Iht) 
(11.43) 

可 以 验证 ， 算 法 性 奇异 的 问题 还 是 存在 。 实 际 
上 ， 当 条 件 〈11.39) 成 立时 ， 对 于 满 秩 的 J 和 J， 
mM. d-JJ) 也 会 降 秩 。 不 过 ， 与 任务 空间 增 
广 法 不 同 ， 只 要 主要 任务 雅 可 比 和 矩阵 满 秩 就 可 以 得 到 
正确 的 主要 任务 解 。 另 一 方面 ， 在 算法 性 奇异 点 之 
外 ， 任 务 优先 级 方法 给 出 的 解 和 任务 空间 增 广 法 是 一 
样 的 。 而 接近 算法 性 奇异 点 时 ， 解 的 品质 变 坏 ， 可 能 
造成 很 大 的 关节 速度 。 这 个 问题 可 以 通过 考虑 有 关 矩 
阵 的 因子 秩 ， 并 根据 适当 的 阔 值 把 矩阵 当成 奇异 的 ， 
在 一 定 程度 上 解决 '"“%!。 这 样 所 得 到 的 关节 速度 是 
有 限 大 小 的 ， 前 提 是 必须 保证 零 空间 分 量 的 连续 性 。 

另 一 种 方法 是 放宽 次 要 任务 速度 重 构 约束 的 最 低 
限度 ， 只 去 跟踪 式 (11.41) 中 不 与 主要 任务 冲突 的 
部 分 中 1 , 即 

g=Ft+U-SI) st, (11. 44) 

这 种 解 的 一 个 直观 依据 可 以 这 样 得 到 : Pee 
和 省 分 别 用 于 求解 各 自任 务 速度 的 关节 速度 ， 然 后 
把 相应 于 约束 任务 (次 要 的 ) 的 关节 速度 投影 到 
的 零 空 间 ， 以 消除 将 引起 与 末端 执行 器 任务 (主要 
的 ) 冲突 的 部 分 ， 最 后 把 它 和 相应 于 末端 执行 器 任 
SRE BM, HAR, f (11.44) 有 一 个 
优良 特性 ， 即 算法 性 奇异 点 与 J 的 奇异 点 是 解 
NN. 

可 以 推断 ， 解 (11.44) 的 约束 任务 重 构 误 差 
比 解 (11.43) 的 更 大 。 这 是 在 跟踪 有 冲突 的 任务 
时 ， 使 给 出 的 关节 速度 轨迹 光滑 可 行 的 代价 。 不 过 ， 
对 于 可 以 在 算法 性 奇异 点 之 外 修复 次 要 任务 跟踪 误 
差 的 CLIK 应 用 , 解 (11.44) 更 好 。 在 这 种 情况 
下 有 


q = 了 wo + -JJJ 


其 中 
w,=t +K,(t-k,(q)) 
ao。 = 上 +K, (t, -k,(4)) 
11.6 二 阶 宛 余 度 求解 


在 加 速度 级 求解 元 余 度 可 以 考虑 机 械 辟 运动 过 程 


的 动力 学 性 能 。 而 且 ， 得 到 的 加 速度 曲线 可 以 直接 作 
为 任务 空间 动力 学 控制 器 的 参考 信号 〈 与 相应 的 位 
置 和 速度 信号 一 起 ) 。 但 另 一 方面 ， 二 阶 宛 余 度 求解 
算法 在 计算 量 方面 总 是 要 求 更 高。 

最 简单 的 加 速度 级 算法 是 式 (11.15) 中 提出 
的 ， 即 给 出 实现 任务 约束 〈11.8) 的 最 小 范 数 解 。 
与 速度 级 伪 道 解 一 样 ， 这 种 局 部 优化 解 生成 的 关节 
运动 无 法 在 机 械 辟 整个 的 运动 过 程 中 使 加 速度 全 局 
最 小 。 不 过 值得 注意 的 是 ， 使 用 式 (11.15) 可 在 
Ci. te] 内 最 小 化 积分 指标 | 9"9dt ， 前 提 是 满足 适 


当 的 边界 条 件 '"”， 比 如 在 端点 自由 的 情况 下 
(t 和 # 时 刻 的 关节 位 置 和 速度 都 没有 指定 ) ， 需 要 满 
足 的 边界 条 件 可 以 分 开 ， 并 表示 为 
g) =J iG) t=, yt, 

因此 ， 虽然 解 (11.15) 表面 上 简单 而 优雅 ， 实 
际 上 最 小 化 上 述 积分 代价 需要 求解 一 个 两 点 边界 值 问 
题 (TPBVP) ， 这 是 个 运算 量 很 大 的 过 程 ， 对 于 实时 
运动 学 控制 是 不 可 行 的 。 不 过 ， 对 于 工业 调试 中 的 离 
线 元 余 度 求解 ， 却 是 非常 令 人 满意 的 。 

通过 考 虚 全 部 的 二 阶 解 (11. 14)， 可 以 更 灵活 
地 选择 (局 部 的 或 全 局 的 ) 性 能 指标 。 将 机 械 臂 动 
力学 模型 表示 为 


T=H(q)q +c(qg,q)+T:(4) (11.45) 
式 中 ，z 为 驱动 力矩 向 量 ; HARE, c 
为 离心 力 / 哥 氏 力 项 ; Ts 为 重力 项 。 取 式 (11.14) 的 
零 空间 加 速度 为 


go = -(HU-S‘J,)\'t (11. 46) 


其 中 
T-HI' (Ë -Jq) +e+T 

CT ARR Bb Ab BR oh hy ETT o HK 
种 特殊 的 宛 余 度 求解 方法 对 于 短 时 间 的 任务 表现 很 
好 ， 但 在 长 时 间 的 运行 中 可 能 会 不 稳定 〈 更 准确 地 
说 ， 是 关节 力矩 会 非常 大 ) ， 本 质 原因 是 零 空间 关 
节 速 度 的 增 大 。 还 要 注意 , 式 (11.46) 中 的 和 矩阵 积 
H(I -JJ,) 是 不 满 秩 的 ， 因 此 它 的 伪 逆 必须 通过 一 
个 SVD 过 程 来 计算 。 整 体 上 最 小 化 关节 力矩 也 是 有 
可 能 的 [5.5 ， 这 种 解 显然 避 开 了 不 稳定 问题 ， 但 又 
需要 求解 一 个 TPBVP。 

另 一 种 有 趣 的 道 解 如 下 

了 =J u(t -Jqg)+U-Sigd)H'e 
(11. 47) 

WRI tO AS, EGE (11.14) 的 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
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本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
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讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
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和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
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期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 
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否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 
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11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
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应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
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就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
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内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
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和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
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进行 综述 。 
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刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
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11.7 循环 性 
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缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
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《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
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机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 
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任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
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应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 
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11.7 循环 性 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
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线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
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11.7 循环 性 
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期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
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分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
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刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
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任意 解法 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
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作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
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和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
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11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
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型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
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《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
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( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
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FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
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分 布 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
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应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
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就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
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内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
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和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 
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11.7 循环 性 
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否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
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构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
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者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
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讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
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和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
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构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
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本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
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中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
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fe (11.47) 最 小 化 了 
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对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
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件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
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刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
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任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
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由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
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历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
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符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
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任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
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符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
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任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
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《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 
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印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
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11.7 循环 性 
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缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
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的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
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兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
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显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
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FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
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(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 
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q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
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机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


208 第 2 篇 ”机 器 人 结构 


轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 
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《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
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机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 
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研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
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AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 
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轻微 改动 。 详 细 地 说 ， 开 ;是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ,惯性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jon =H (JB J 
fe (11.47) 最 小 化 了 


EO 
印 机 械 臂 动能 在 [i,t] EARS). AA 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


q(t) = yt (2) 
11.7 循环 性 


基于 微分 运动 学 的 宛 余 度 求解 算法 的 共有 和 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关 节 的 最 终 位 置 和 初始 位 置 不 -- 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 辟 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满足 的 数学 条 件 '" 引 。 特 别 地 ， 考 虚 如 下 形式 的 
任意 解法 


t=t, ,t, 


q=G(q)t (11. 48) 
式 中 ，G, ESER HERE J, 的 任意 一 种 广义 逆 ， 
BNE JGJ, = J, 的 一 个 Nx M SRE (È (11.13) 
中 的 伪 逆 矩阵 元 就 是 一 种 特殊 的 广义 道 ) 。 设 给 定 任 
FA) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， 并 令 g; (9) RRG 的 第 i 列 。 式 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 

AG, (q) = span { 2, (gq) -gu (gq) | 

是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 )。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( BI Pai, tan A bh at 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 2 TA BER ARE, NG 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11.32)， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 起 宛 余 机 械 辟 


研究 运动 学 元 余 时 产生 的 一 个 自然 问题 就 是 . 
当 关 节 数 (而且 因此 完 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ? 自然 
符 存 在 具有 许多 关节 的 捉 联 刚性 连 杆 系统 的 例子 
《比如 蛇 、 哺 乳 动物 和 鱼 的 背 椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 户 发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
BU ARBITRARY. (Ak, 七 或 八 自由 度 的 空间 
刚性 杆 机 械 臂 一 般 不 被 认为 是 超 完 余 的 。) BTA 
机 械 臂 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何 ) 元 余 度 的 增加 都 
将 增加 新 的 基本 能 力 〈 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许 多 引起 人 


兴趣 的 生物 超 宛 余 系统 实际 上 只 做 相对 有 限 的 运动 


由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) 蛇 的 脊椎 有 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度， 频率 ) 决定 。 
内 此 ， 设 计 者 和 算法 开发 人 员 找到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 辟 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 硬件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
加: 类 痊 椎 动物 的 刚性 杆 设 计 和 类 无 疹 椎 动物 的 连续 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 元 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 完 余 设计 


按照 从 传统 的 串联 刚性 连 杆 机 械 辟 (ARAE 
TRH) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) 。 这 类 机 器 人 
设备 一 个 很 好 的 早期 实例 是 JPL ET WL BE A ， 


